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ABSTRACT 


This  paper  describes  simplified  mathematical  models  of 
the  Manned  Maneuverina  Unit  (MMU)  used  in  the  USAFA  Proxim¬ 
ity  Operations  Simulator  for  the  VAX  11/780  and  the  Evans 
and  Sutherland  PS  300  computers.  This  simulator  serves  as  a 
learninq  aid  for  cadets  studyinq  orbital  dvnamics  and  MMU 
mission  planning  and  as  a  research  platform  for  the  Depart¬ 
ment  of  Astronautics. 
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INTRODUCTION 


'  r  -  4*  / 

\  • '  1  A 

'-“■The  Manned  Maneuvering  Unit  (MMU)  Proximity  Operations 
Simulator  is  a  nine  degrees-of-freedom  trajectory  integrator 
(six  degrees  of  freedom  for  the  MMU  and  three  degrees  of 
freedom  for  the  target)  which  generates  digital  and  graphi¬ 
cal  data  to  describe  relative  motion  of  the  MMU  and  a  free- 
flying  target.  This  motion  is  obtained  by  applying  the 
Clohessy -Wiltshire  equations  for  terminal  rendezvous /docking 
with  the  earth  modeled  as  a  uniform  sphere  fA^*pendix  A)  and 
aerodynamic  forces  ignored.  MMU  position  relative  to  target 
is  computed  by  a  first-order  Euler  integrator  which  uses 
quaternions  to  define  the  rotational  state  fjqa^endix  B~) . 


The  target 
(STS)  Orbiter. 
mass  properties 
tia,  and  center 
gram  and  remain 


is  modeled  as  a  Space  Transportation  System 
The  MMU  is  treated  as  a  rigid  body  whose 
(gross  weight,  moments  and  products  of  iner- 
of  gravity  location)  are  set  within  the  pro¬ 
constant  for  the  entire  simulation, 


UU  * 

:  lnefl 


The  initial  state  of  the  simulation  is  defined  by  the 
user.  The  program  requires  altitude  and  inclination  of  tar¬ 
get  orbit  to  determine  proper  viewing  perspective  and  orbi¬ 
tal  dynamics.  The  user  must  also  input  MMU  position  rela¬ 
tive  to  target.  The  program  sets  relative  velocity  and 
rotation  rates  to  zero  and  defines  initial  MMU  attitude  such 
that  the  operator  faces  the  target  with  his  feet  pointed 
towards  the  earth.  The  user  also  has  the  option  of  multi¬ 
plying  MMU  responsiveness  to  facilitate  proximity  operations 
training . 


After  program  initialization,  user  inputs  are  made 
through  the  hand  controllers  located  in  the  MMU  Mockup.  The 
left  controller  is  the  Translational  Hand  Controller  ( THC ) 
and  is  used  for  positioning.  The  right  hand  controller  is 
the  Rotational  Hand  Controller  ( RHC )  and  controls  MMU  atti¬ 
tude.  Cross-coupling  accelerations  are  not  modeled  in  the 
simulation.  The  program  reads  inputs  from  the  mockup  and 
updates  position  and  attitude  every  40  milliseconds. 


2  . 


MMU  ACCELERATION  modeling 


Tabl  e  1  contains  the  steady-state  MMU  accelerations 
used  in  the  simulation.  Attitude  deviations  induced  hv 
cross  couplinc  are  not  included  .  These  accelerations  are 
fixed  within  Subroutine  THPUST  and  cannot  he  chanced  by  the 
operator . 
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3. 


DETERMINING  POSITION  AND  ATTITUDE 


The  MMU  translational  accelerations  are  added  to  the 
orbital  drift  accelerations.  These  accelerations  are  then 
integrated  twice  to  yield  velocity  and  position.  Attitude 
is  determined  by  applying  rotational  accelerations  to  the 
present  quaternions. 

The  Clohessy-Wiltshire  equations  for  terminal 
rendezvous/docking  are  used  to  model  orbital  drift.  These 
are  linearized  equations  of  motion  for  an  interceptor  vehi¬ 
cle  relat i ve  to  a  target  vehicle  in  a  circular  orbit  with 
Kepler ian  mot  ion . 

x  =  f x'  -  2ury  (1) 

y  =  f  '  +  3ui2y  +  2ux  ( 2 ) 

V  =  fz'  -  ui2z  (3) 

where  fx',  f  ',  and  fz'  are  the  MMU  translational  accelera¬ 

tion  components  (due  to  thrust),  and  iu  is  the  rotation  rate 
of  the  target  about  the  planet. 

The  target  frame  is  a  right  handed  orthogonal  system 
where  x  is  the  direction  of  target  velocity,  y  is  the  zenith 
direction  (along  target  radius  vector),  and  z  is  out  of 
orbital  plane  (opposite  the  angular  momentum  vector).  For 
further  explanation  and  derivation  of  Equations  9-11  refer 
to  Appendix  A. 

The  translational  accelerations  due  to  drift  and  thrust 
are  summed  in  Subroutine  THRUST  and  then  integrated  in  Sub¬ 
routine  LINTEG.  LINTEG  is  a  first  order  Euler  integrator 
which  was  chosen  for  fast  computational  speed  (needed  in 
real  time  simulation)  in  liqht  of  the  fact  that  accelera¬ 
tions,  and  hence  error,  will  be  small. 

The  rotational  accelerations  are  transformed  from  the 
body  frame  to  the  reference  (target)  frame  by  Subroutine 
BTOR.  These  accelerations  are  then  used  by  Subroutine 
ROTATE  to  determine  a  new  attitude  quaternion  and  transfor¬ 
mation  matrix.  The  equations  used  in  Subroutine  ROTATE  are 
included  in  Appendix  B. 


4.  GENERATION  OF  VISUAL  DISPLAY 


The  simulator  uses  an  Evans  and  Sutherland  PS300  com¬ 
puter  for  visual  display.  Three  dimensional  object  data  are 
loaded  and  stored  in  the  mass  memory  of  the  PS300  at  the 
bepinninp  of  the  propram.  These  data  are  then  rotated, 
translated,  and  displayed  repeatedly  as  commanded  by  the 
main  propram  from  the  VAX  11/780. 

Subroutine  PS300  is  responsible  for  loadinp  the  object 
data,  known  as  vector  lists,  and  providinp  a  hierarchy  of 
rotation,  translation  and  viewinp  commands  for  later  input 
by  Subroutine  LOOK.  The  vector  lists  consist  of  a  spherical 
outline  of  the  earth's  continents,  a  star  sphere,  a  circular 
horizon,  and  STS  Orbiter.  The  reference  coordinate  system 
is  the  Clohessy-Wiltshire  system,  centered  at  the  tarpet  and 
described  in  detail  in  Appendix  A. 

The  earth's  vector  list  is  scaled  at  one  distance  unit 
(DU)  and  rotated  about  its  axis  at  the  rate  of  15  depress 
per  hour.  The  earth  is  then  inclined  and  counter-rotated  a 
rate  epuivalent  to  the  anpular  rate  of  the  tarpet  orbit . 
Finally,  it  is  translated  in  the  -Y  direction  an  amount 
equal  to  its  radius  plus  tarpet  altitude.  To  complete  the 
earth  picture  a  horizon  circle  is  added  and  the  earth  vector 
list  is  clipped  to  prevent  viewinp  beyond  the  horizon. 

The  star  vector  list  is  triplicated  and  rotated  DO 
deprees  about  each  axis  to  create  a  unit  sphere  of  stars. 
This  representation  does  not  reflect  true  star  positions. 
The  sphere  is  scaled  up  by  a  factor  of  one  earth  radius  plus 
twice  tarpet  altitude  and  set  counter-rotatinp  (as  was  the 
earth).  The  star  sphere  is  then  translated  in  the  -Y  direc¬ 
tion  an  amount  eoual  to  one  DU  plus  tarpet  altitude  and 
clipped  so  no  stars  appear  below  the  horizon. 

The  Orbiter  vector  list  is  scaled  and  placed  at  the 
center  of  the  reference  coordinate  system.  It  is  not 
clipped  and  remains  at  the  oripin  throuphout  the  simulation. 
Run  time  is  displayed  in  the  upper  left  hand  corner. 

Subroutine  LOOK  uses  MMIJ  position  and  attitude  data 
relative  to  the  tarpet  to  continuously  update  rotation, 
translation,  and  viewinp  of  all  the  predefined  vector  lists. 
Current  position  and  attitude  are  used  to  penerate  three 
viewincr  vectors  in  the  reference  (tarpet)  frame:  AT,  FROM, 
and  UP.  AT  is  the  line  of  siaht  vector,  FROM  is  the  posi¬ 
tion  vector,  and  UP  is  the  overhead  vector  l  perpenrfi  cular  to 
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AT) .  The  Evans  and  Sutherland  PS300  uses  these  viewing  vec¬ 
tors  to  scale,  translate,  and  re-orient  the  stored  imaqes 
for  perspective  viewing.  Figure  1  shows  the  relationship  of 
the  stored  images  to  each  other  and  how  they  are  viewed 
given  AT,  FROM  and  UP  vectors. 
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APPENDIX  A 


(This  appendix  was  taken  wholly  from  Reference  2) 


TERMINAL  RENDEZVOUS/DOCKING 


This  appendix  develops  the  equations  of  motion  for  an 
interceptor  vehicle  relative  to  a  target  vehicle  in  orbit 
about  a  central  body  when  the  range  between  vehicles  is  less 
than  8  km  (5  miles). 


The  following  approach  will  be  taken  to  solve  this 
engineering  problem. 


1 . 


Establish  a  coordinate  system: 

a.  Origin  at  target  vehicle 

b.  Orthogonal  right-handed  system 

c.  x  —  In  the  local  horizontal,  in 

direction  of  target 
vehicle  velocity  vector 

d.  y  —  In  zenith  direction  (along 

target  vehicle  position 
vector  R) 

e.  R  —  Vector  to  target  in  fixed 

frame 


A 


f.  r  —  Vector  to  interceptor  in 
fixed  frame 


Figure  2 


g.  p  =  r  -  R  —  Position  of  the  interceptor  relative  to 

the  target. 

2.  Apply  5  F  .  =  -^-(mv)  in  the  rotatinq  coordinate  system: 
ext  at 

a.  This  is  a  double  application  of  the  law  of  coriolis 
for  derivatives  in  a  rotating  frame.  (If  you  can't  derive 
this,  see  BMW  pp.  92-93.) 


b.  When  (  )  is  the  position  of  the  interceptor  vehicle, 
( r ) ,  then 


=  f  =  r  R+uixr+uixuixr  +  2uixr  R 


c.  Noting  the  following  relat ionships 


( 1 )  ui  =  -ui  z 


(7)  P  _  =  R  y 


(  2  )  ui  =  -ui  z 


(8)  R  R  =  R  y 


(3)  p=xx+yy+zz  (9)  r=xx+  (R  +  y)  y  +  z  z 

•  • 

•  •  •  t  •  •  • 

(4)  pR  =  xx  +  yy  +  zz  (10)  rR=xx+(R+y)y+zz 

•  •  •  • 

•  •  ••  ••  ••  ••••  •• 

(5)  pR=xx+yy+zz  (11)  rR=xx+  (R  +  y)  y  +  z  z 

(6)  R  =  R  y 


d.  Developing  the  reguired  cross  products 


ui  x  r  =  ui(R  +  y)  x  -  uk  y 

ui  x  r  =  ui(R  +  v)  x  -  uk  y 

—  —  —  2  „  2 

ui  x  ui  x  r  =  -ui  x  x  -  ui  (R  +  y)  y 

e.  Now  substituting  from  c  and  d  into  the  component 
form  of  the  vector  equation  developed  in  2.b,  we  obtain 

fx  =  x+ui(R  +  y)  -  ui^x  +  2ui(R  +  y) 
f  =  R  +  y-  UK-iu^(R  +  y)- 


2uk 


f.  Now,  let  f”  be  the  specific  force  other  than  the 
qravitational  attraction  of  the  central  body  (i.e.,  drag, 
thrust,  solar  pressure,  etc.) 


f  a  f'  +  f  =  f '  _  x 

^  r 

OR 


f  = 


f  ' 
x 


f  = 


f  ' 

y 


f  = 


f  ' 
z 


ux 

3 

r 

u(R  +  y) 

3 

r 

tiz 

3 


g.  Then  the  relative  motion  is  described  by 

•  •  •  «  •  • 

x  =  f  '  -  tu(  R  +  y )  +  ui  x  -  2ui(  R  +  y )  -  ^ 

r 

y=f  '  -  R+  uix+m2(R  +  y)  +  2vux  -  ^ 

y  r 

,  .  nz  .  3  r  2  .  x  >2  x  2,3/2 

z  =  f  -  — ^  where  r  =  lx  +  (R  +  y)  +  z  ] 

z  r 

THESE  ARE  VERY  NON-LINEAR,  BUT  EXACT  EQUATIONS  OF  MOTION. 
3.  Linearize  the  equations  to  find  an  analytic  solution: 
r3  =  R3  [(£)2  +  (1  +  |)2  +  (|)2]3/2 

=  R3  Cl  +  ^  +  (|)2  +  (^)2  +  (f)2]3/2 


a . 


Since  x,  y  and  z  are  small  compared  with  R, 


b.  Then  the  last  terms  in  the  equations  of  2.g.  take  on 
the  form 


ju_  ~ 
3  ~ 


R3(l  + 


c.  Since  the  term  (^)  is  small  (less  than  0.00125),  use 
the  binominal  expansion  to  beqin  to  simplify  these  equations 

(1  +  «r3/2  =  1  -  |  <  +  I*  .2  -  ... 

d.  Then,  substituting  into  2q  and  neqlecting  the  small 
high  order  terms, 


_ £2? _ 

R3<1  +  ^,-3/2 


_  «*  +  3jjyy 

_  f  .  ,  ere, 

R  R 


So  that 


x=f  '  -  ui(R  +  y)  +ui2x-  2ui(  R  +  y)  -  ^4  + 

x  R  R 


y  =  f  ' 
Y 


R  +  UK  +U13(P  +  y)  +  2uk  -  +  — — r- 

R  Rj  R 


z  =  f  ' 
z 


pz  3pzy 
'  R3  R4 


e.  The  only  nonlinear  terms  are  the  last  ones  in  the 
equations.  These  terms  are  smaller  than  the  proceeding 
terms  by  (^) .  Neqlectinq  these  terms  results  in 

x  =  f  '  -  ui(R  +  y)  +  (ui3  -  -^r)x  -  2in( P  +  y) 

x  R 


V  =  f  '  -  R+VUX+  (uj3-  )  R  +  (  uj^  +  )  y  +  2iux 


4.  Now  ASSUME  the  target  vehicle  is  in  a  CIRCULAR  orbit 


a  -  Then 


ui  = 


=  -Mr  ,  m  =  -Mr  ,  ui  =  0  ,  R  and  R  =  0 

\jr3  ? 


b.  The  equations  of  motion  become 


x  =  f  '  -  2uy 


y  =  f  '  +  3in  y  +  2uk 


r  *  4 

Z  =  t  -  m  z 


THESE  ARE  THE  LINEARIZED  EOUATIONR  OF  MOTION  FOR  AN  INTER¬ 
CEPTOR  VEHICLE  RELATIVE  TO  A  TARGET  VEHICLE  IN  A  CIRCULAR 
ORBIT  WITH  KEPLARIAN  MOTION. 


APPENDIX  B 


(This  appendix  was  taken  wholly  from  Reference  3) 
ATTITUDE  DETERMINATION  USING  QUATERNIONS 


The  quaternion  q  describinq  the  orientation  of  a  body  with 
respect  to  a  reference  coordinate  frame  may  be  found  by 
integrating  the  quaternion  differential  equation: 


where 


q  =  iq^  +  5<?2  +  +  ^4 

ui  =  iu^  +  jiUy.  +  ku^, 

=  rate  of  rotation  of  body  with  respect  to  the 
reference  frame  (in  body  coordinate  frame). 

Expansion  of  (1)  yields  the  following  form: 


f  > 

*1 

0 

_UV 

Nj 

f  V 

ql 

q2 

1 

0 

q2 

~  T 

• 

q3 

"V 

0 

q3 

q4 

""k 

-UV 

0 

q4 

**  > 

X 

J 

The  quaternion  components  in  the  body  (X,  Y,  Z)  cor rdinate 
frame  are 


where 


A  vector 
by 


where 


q2 

<*3 


UI 

Ul 

111 

COS 


sin 

sin 

sin 

uit 

2 


u± 

2 


uit 

2 


uit 

2 


(3) 


n  /  2  ,  2  7  2  ^ 

m  =  y*  + 

is  transformed  from  body  to  reference  coordinates 
XR  =  qXBq*  (4) 

<3*  =  -iqj^  -  5^2  “  ^q3  +  q4 
=  conjuqate  of  q 

qq*  =  q*  q  =  1 


The  equivalent  equation  in  vector-matrix  notation  is 


«  ca 


If  (4)  and  (5)  are  expanded  and  compared,  it  is  seen  that 


>s  S 


ql-q2~q3+q4  2(cflq2~q3q4)  2(qlq3+q2q4) 


2(qiq2+q3q4) 


2.2  2.2 


-ql+q2~q3+q4 


2(q2q3'qlq4) 


2(qlq3~q2q4)  2(q2q3+qlq4) 


2  2  2  2 
-ql-q2+a3+q4 


(6) 


From  (6),  the  quaternion  components,  expressed  as  functions 
of  the  matrix  elements,  are 


= 


q->  - 


1 

4q4 

(T32 

T23  ^ 

1 

4q4 

(T13 

1 

4q4 

(T21 

T12) 

7  '\  / 

1  +  T 

i  + 

(7) 


.....  x 


C**AAAAAA*A*AAAAAAAAAAAAAAAAAAAAA*AAAA»AAAAAAAAAAAAAA 

C  PRODUCED  BY  THE  UNITED  STATES  AIR  FORCE  ACADEMY 
C  DEPARTMENT  OF  ASTRONAUTICS  AND  IS  NOT  PROTECTED 
C  9 Y  COPYRIGHT.  (17  U.S.C.  SECTION  105) 

C  PROGRAM  IS  BASED  ON  WORK  BY  USAFA/DFAS. 

C  AUTOVON  259-41 1 C  COMMERCIAL  303-472-4110 

c AA aaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaa 

c 

C  EXECUTES  THRUST  COMMANDS  FOR  PROXIMITY  OPERATIONS 

C  Of  MANNED  MANEUVERING  UNIT. 

C  QUESTIONS  ?????  CONTACT  CAPT  ALFANO*  DF AS 

C 

C  LINK  AS  FOLLOWS 

C  LINK  MHUSIM, C AL F A NO 3 E R R 0 R , LPA 1 0* G S R F /L I B 


C 

INCLUDE  *  CAL  FAN  CD  PROCONST. FOR/ NOLI  ST* 

C 

REAL  X(6)*T (3s3)sQ(4) 

REAL  UB<3>,ALTrA9(3>,AR<3>rANG<3) 

REAL  DELTAT, UP(3)*FUDGE*ST0PIT 
REAL  DELT1 , D£ LT 2 , I NCL I N, T I  ME 
REAL  RANGE,0MEGA,0LDX(3> 

C 

INTE GER*4  SYSSSETEF, SYS* WAITFR, CHAN 
INTEGER *2  I BU F ( 1 93) , IOSB (4) 

INTEGER  C(1 2),  I, J/ D C  (  1  2 > , RE S TO P, OVHD ( 1 2 ) 

INTEGER  NLOOPS, RESET, FLAG 
CHARACTER*16  TIM8UF 
INTEGERS  TIMADR 
C 

C  A 3 ( 3 )  -  ACCELERATION  (BODY  FRAME) 

C  ALT  -  ALTITUDE  OF  TARGET  (KM> 

C  ANG  <  3)  -  ANGULAR  ACCELERATION  (BODY  FRAME) 

C  AR ( 3 )  -  ACCELERATION  (REF  FRAME) 

C  CHAN  -  CHANNEL  FOR  PS30G  PHYSICAL  I/O 

C  DELT1/2  -  TIME  COUNTERS  TO  SEE  IF  LOOP  EXCEEDS  .04  SEC 

C  DELTAT  -  TIME  STEP 

C  FLAG  -  FLAG  TO  READ  SHUTTLE  MOCKUP 

C  FUDGE  -  FUDGE  FACTOR  TO  CHANGE  MMU  RESPONSIVENESS 

C  I BU  F  -  BUFFER  FOR  PS300  PHYSICAL  I/O 

C  INCLIN  -  INCLINATION  OF  TARGET  ORBIT  (DEG) 

C  1053  -  ARRAY  FOR  PS300  PHYSICAL  I/O 

C  NLOOPS  -  LOOP  COUNTER 

C  OLDX (3)  -  ORIGINAL  MMU  POSITION  FROM  TARGET  IN  C-W  FRAME 

C  OMEGA  -  ANGULAR  RATE  OF  TARGET  ABOUT  EARTH  (RAD/SEC) 

C  0 VHD ( 1 2)  -  ARRAY  FOR  COMMANDS  FROM  SHUTTLE  MOCKUP 

C  0(4)  -  QUATERNION 

C  RANGE  -  RANGE  FROM  TARGET 

C  RESET  -  COMMAND  FLAG  TO  START  OVER  FROM  ORIGINAL  POSITION 

C  RESTOP  -  COUNTER  TO  STOP  PROGRAM  IF  RESET  HELD  FOR  1  SEC 

C  STOPIT  -  MAX  RUN  TIME  (MINUTES) 

C  T (3,3)  -  TRANSITION  MATRIX  (BODY  TO  REFERENCE  FRAME) 

C  TIME  -  TIME  (SEl ) 

C  T IM3UE  ,T IMADR  -  USED  TO  SET  ITERATIVE  LOOP  TO  DELTAT 

C  UP( 3 )  -  UP  VECTOR  FOR  PS300  AND  ALIGNMENT  SUBROUTINE 

C  U 3 ( 3 )  -  ROTATION  RATE  (80DY  FRAME) 

C  X ( 6 )  -  MMU  POSITION/VELOCITY  FROM  TARGET  IN  C~W  FRAME 

C 

c 


ASSIGNMENT  OF  THRUST  COMMANDS 


C-3 


c 

c<  )  - 

COMMAND  ARRAY 

c 

c 

C  <1 )  - 

♦  X 

c 

C<2>  - 

-X 

c 

C  C  3  >  - 

♦  Y 

c 

CCA)  - 

-v 

c 

C  (5)  - 

♦  Z 

c 

C  (6)  - 

-z 

c 

C  <  7 )  - 

♦ROL 

c 

CCS)  - 

-ROL 

c 

CC9)  - 

♦  PCH 

c 

CC10) 

-  -PCH 

c 

can 

-  +YAW 

c 

CC12) 

- YAW 

c 

c 

1=0N 

0=0F  F 

C 

c 

c 


c 

c 

c 

c 

c 

c 


c 

c 

c 


c 

c 

c 


c 

c 

c 


INITIALIZATIONS 

DATA  TIHBUF / * OOOO  00:00:00.12*/ 

DATA  CCCI),I=1#12)/12*0/ 

DATA  <X<I),I=1#6)/6*0 / 

SET  TIMER 

CALL  SYS$BINTIMCTIMBUF#TINADR> 

READ  IN  MAX  RUN  TINE 

PRINT  *,•  NOW  MANY  MINUTES  DO  YOU  WISH  TO  RUN  ?* 

PRINT  *,•  C IF  OVER  10,  PLEASE  COORDINATE  WITH  SEILER)* 
READ  *,  ST OPIT 

READ  IN  TARGET  ALTITUDE 

PRINT  *,•  ENTER  ALTITUDE  OF  TARGET  CKM)  * 

READ  ALT 

COMPUTE  ROTATION  RATE  OF  TARGET  ABOUT  EARTH 

OMEG A* SORT! 398600.8/ CALT+637 8.1 35) **3) 

READ  IN  INCLINATION  OF  TARGET  ORBIT 

PRINT  *,*  ENTER  INCLINATION  OF  TARGET  ORBIT  (DEG)* 

READ  *r INCL I N 

READ  IN  FUDGE  FACTOR 

PRINT  *,  * BY  WHAT  FACTOR  WOULD  YOU  LIKE  TO  INCREASE* 
PRINT  *,  * MMU  RESPONSIVENESS  ?' 

READ  FUDGE 

READ  IN  INITIAL  MMU  POSITION 

PRINT  *,•  ENTER  COORDINATES  OF  MMU  FROM  TARGET* 

PRINT  *,*  X,Y,Z  CLOHESSY-WILTSHIRE  FRAME  (FEET)' 

READ  *,OLDX<1),CLDX<2),OLDX(3> 


C 

C 


ZERO  VELOCITY  AND  ANGULAR  MOTION  ARE  ASSUMED  FOR  MMU. 


MMU  ALIGNMENT  IS  INITIALIZED  SUCH  THAT  TARGET 
STARTS  IN  CENTER  OF  SCREEN  (X  IN  BODY  FRAME) 


INITIALIZE  PS30Q  DISPLAY 

INITIALIZE  DR-11K  HAND  CONTROLLER  BOARD 

READ  MEMORY  ADDRESS  LOCATIONS  IN  PS300 

CALL  PS300CALT/-INCLIN) 

CALL  IOBUFFd /DCrRESET) 

CALL  INIT6UFCI8UF,CHANrI0SB> 

SET  EVENT  FLAG  FOR  WAIT  COMMAND 

CALL  SYSSSETEF (7) 


RE 

SET 

BEG  I 

CONT 

INU 

E 

WS(1 

)  =  0 

.0 

W3  (  2 

>  =  0 

.0 

W8  (  3 

)=0 

.0 

DELT  AT= 

.04 

UPC1 

>  =  0 

.0001 

UP  (  2 

)=1 

.0 

UP  <  3 

)=0 

.0001 

X  Cl ) 

=  OL 

DXC1  ) 

X  (  2) 

-OL 

DXC2) 

X(  3) 

=  OLDX  <  3  ) 

XC4) 

=  0. 

0 

X  (  5) 

=  0. 

0 

X  <  6) 

=  0. 

0 

DO  1 

75 

1=1/- 1 

cc 

I)  = 

0 

DC 

Cl) 

=0 

CONTINUE 


ALIGN  MMU  SO  TARGET  IS  CENTERED  IN  WINDOW 


CALL  AL 

IGNC 

X(1)/XC2)/X<3>/-T/-0/-UP) 

INIT 

I  AL  I 

ZE  COUNTERS 

NLOOPS= 

-1 

DELT1 =S 

c 

o 
U J 

SCO.) 

RESET=0 

FLAG=0 

ITERATIVE  LOOP  BEGINS  HERE 

CONTINUE 

UPDATE  COUNTERS 

NLOOPS=NLOOPS+t 

TIME=NLOOPS*DELTAT 

FLAG=FLAG*1 


C-5 


C 

C  APPLY  COMMANDS  CC) 

C 

CALL  THRUST  CAB, ANG,C) 

C 

C  APPLY  FUDGE  FACTOR 

C 

ASCI)* FUDGE *ABC1> 

ABC2)*FUDGE*ABC2> 

AB(3)*FUD6E*ABC3) 

C 

C  TRANSLATE  BODY  ACCELERATIONS  CAB)  TO  REF  FRAME  CAR) 

C 

CALL  8T0R<T,AB,AR) 

C 

C  APPLY  ACCELERATIONS  TO  DETERMINE  POSITION  CXC1-3)) 

C  AND  VELOCITY  (XC4-6))  OF  MMU  RELATIVE  TO  TARGET 

C  USING  CLOHESSY-VILTSHIRE  EQUATIONS. 

C 

CALL  LINTE6(X,0ME6A,AR,DELTAT) 

C 

C  APPLY  ANGULAR  ACCELERATIONS  TO  FIGURE  QUATERNIONS  AND  NEW  T  MATRIX 

C 

CALL  ROTATE  (AN6,DELTAT,UB,Q,T) 

C 

C  DETERMINE  TARGET  POSITION  AND  ATTITUDE 

C  AS  SEEN  DIRECTLY  AHEAD. 

C  DISPLAY  ON  THE  PS300 

C 

CALL  LOOK(T,X(1 >, XC2),XC3), OMEGA, TIME,IBUF, CHAN, IOSB) 

C 

C  READ  THRUST  COMMANDS 

C 

IF  C FLAG  .GE.  3)  THEN 

CALL  IOBUFFC2,OVHD, RESET) 

CALL  SYSSUAIT FRC7) 

CALL  SYSSSETIMRC7,TIMADR,,> 

C 

C  IF  RESET  HELD  FOR  25  ITERATIONS,  STOP  PROGRAM 

C  IF  RESET  COMMANDED  GO  TO  135 

C 

IF  (RESET  .EQ.  1)  THEN 
RE$TOP=RESTOP+1 
IF  (RESTOP  .GE.  15)  GOTO  999 
60T  0  135 
ELSE 

REST0P=0 

ENDIF 

FLAG*0 

C 

C  CONVERT  FROM  SHUTTLE  CONTROLLERS  TO  MMU 

C 

DC  (')  )=OVHD(2) 

DC(2)*OVMD<1> 

DC (3) *0VHD(4) 

DC (4) =OVHD(3) 

DC (5) *OVHD( 5) 

DC (6) *0VHD<6) 

DC (7)*0VHDC8) 

DC (8)*0VHD(7) 


C-6 


DC<9)*0VHD<10> 

DC (10)*0VHD(9) 

DC<11>«0VHD(11> 

DC  (1 2)*0VHD(1 2) 

ENDIF 

RESTORE  THRUST  COMMANDS 

DO  645  1*1*12 
C  < I)  =  DC (I ) 

CONTINUE 

RETURN  TO  450  FOR  NEXT  ITERATION 
IF  (NLOOPS  .LT.  (1 500*STOPIT) )  GOTO  450 
COMPUTE  AVERAGE  LOOP  TIME 
DELT2=SECNDS(DELT1) 

PRINT  *,•  AVERAGE  LOOP  TIME  *  *  *  DELT2/NL00PS# '  SECONDS* 


CONTINUE 


SUBROUTINE  ALIGN (X* Y* 2 * T* 0* UP) 

COMPUTES  BODY  AXIS  COMPONENTS  IN  REFERENCE  FRAME. 
-XBOD  IS  THE  POSITION  VECTOR.  Z80D  AND  YBOD 
COMPLETE  THE  RIGHT  HANDED  SYSTEM. 

DETERMINES  QUATERNION  (Q)  AND  TRANSFORMATION 
MATRIX  CT). 

REAL  X*Y*Z*T<3*3)#Q(4)*UP<3>*C0NST 
REAL  XBOD(3)*Y30D(3)*ZB0D(3) 

XBOD ( 1 ) *“X 
XBOD (2) *— V 
XBOD  <3)=-Z 

DO  NOT  ALLOW  XBOD  TO  LIE  DIRECTLY  ON  AN  AXIS. 
THIS  IS  DONE  TO  PREVENT  QUATERNION  AMBIGUITIES. 


IF  (ABS(XB0D(1)}  .LT.  .001) 
IF  C ABS (XB0DC2) )  .LT.  .001) 
IF  (ABS ( XBOD ( 3) )  .LT.  .001) 


XB0D(1)*. 001 
XB0D(2)*.OO1 
XB0D(3)=.001 


COMPUTE  TRANSFORMATION  MATRIX 

CALL  UNITIZE(XBOD) 

CALL  CROSS(Y80D*X90D*UP> 

CALL  UN  IT  I Z  E ( YBOD) 

CALL  CR0SS(Z30D/X90D*YB0D) 

CALL  UNITIZE(ZBQD) 


sw 


T(1,1)*XB0D(1) 

T(1,2>*Y80D(1 ) 

T(1,3)  =  Z30Dd) 

T(2*1)*X80D(2) 

T (2*2)=YB0D(2) 

T(  2*  3) *Z80D (2) 

T (3#1 )=XBOD  C3) 

T(3,2)*YB0D(3) 

T ( 3*  3)  =  ZB0D (3) 

COMPUTE  QUATERNIONS 

Q(4)=1.0<>T(1*1>*T(2,2>*T(3,3> 

IF  (0(4)  .LT.  .IE-30)  0(4)=. IE-30 

Q(4)=SQRT(0(4))/2.0 

Q(1)=(T(3*2)-T(2*3))/(4.0*Q(4)) 

Q(2)*(T(1*3>-T<3/1))/(4.0*Q(4)> 

9(3)*(T(2/1)-T(1/2))/{4.0*Q(4)) 

NORMALIZE  OUATERNIONS 

CONST® SORT (Q(1)*Q(1)+Q(2)*Q(2)+Q(3)*Q(3)+Q(4)*Q(4)) 

Q(1)=0(1)/C0NST 

0(2)=0(2)/C0NST 

Q(3)=Q(3)/C0NST 

0(4) =0(4) /CONST 


SUBROUTINE  THRUST (A^ANS^C) 

A  -  ACCEL  X,Y*Z  (FPS2#B0DY  FRAME) 

ANG  -  ANGULAR  ACCEL  XsYsZ  (RAD/S2*B0DY  FRAME) 

REAL  A(3)sAN6(3) 

INTEGER  IsJsC (1 2) 


INTIALIZE  A  ANO  ANG 

00  20  1*1  *3 
ANG ( I )=0. 0 
A(I)=0. 0 
CONTINUE 

DETERMINE  ACCELERATIONS  DUE  TO  COMMANDED  THRUST 


IF 

(CO) 

.EQ. 

1) 

AO  )  =  . 

323 

IF 

(C(2) 

.EQ. 

1) 

AO  )*- 

.323 

IF 

(  C  (3) 

.EQ. 

1) 

A  (  2  )  =  . 

323 

IF 

(  C  (  4  ) 

.EQ. 

1) 

A(2)=“ 

.323 

IF 

(  C  (5  ) 

.EO. 

1) 

A(3)=. 

323 

IF 

(C(6) 

.EQ. 

1) 

A (3 ) *- 

.323 

IF 

(  C  (7) 

.EO. 

1) 

ANGC1  ) 

=.142942 

IF 

(C  (  8) 

.EQ. 

1) 

ANG(1) 

*-.142942 

IF 

(  C  (9  ) 

.EQ. 

1  ) 

ANG ( 2 ) 

=.13927 

IF 

(COO) 

.EQ. 

.  1) 

ANG  <  2 

>*-.13927 

IF  <C<11)  .  EQ.  1)  ANG<3>=. 158127 
IF  <  C (1 2)  .EQ.  1>  ANG<3>=-.1 58127 


END 


SUBROUTINE  LINTE6(XsOMEGA#A*DELTAT) 

C 

C  THIS  IS  A  FIRST  ORDER  INTEGRATION  SCHEME  FOR  TRANSLATIONAL 

C  ACCELERATIONS  IN  THE  REF  <C-W>  FRAME  USING  C“W  EQUATIONS 

C 

REAL  X<6),XD0T<6>,A(3)*0N£6A,DELTAT 
INTEGER  J 
C 

C  A(  1-3)  -  Xs  Ys  Z  ACCELERATION 

C  XC1-3)  -  X,Y POSITION 

C  XIA-6)  -  X,Y*Z  VELOCITY 

C  DELTAT  -  TINE  STEP 

C  ONEGA  -  ANGULAR  RATE  OF  TARGET  ABOUT  EARTH 

C 

XDOT (1 )*X (4) 

XDOT  < 2) *X (5 ) 

XDOT  (3) *X (6) 

C 

C  BELOW  ARE  THE  LINEARIZED  EQUATIONS  OF  NOTION  FOR  AN  INTERCEPT 

C  VEHICLE  RELATIVE  TO  A  TAR6ET  VEHICLE  IN  A  CIRCULAR  ORBIT 

C  WITH  KEPLARXAN  NOTION 

C 

XD0TC4)*A(1)-2.0*0N£GA*X<5) 

XDOT<5)*A<2)*3.a*OHEGA*OMEGA*X(2>*2.0*OHEGA*xm 

XDOT<6)=A(3)-X<3)*OM£GA*ONEGA 

C 

DO  100  J *1  * 6 

X(J)=X<J) ♦DELTAT* XDOT CJ) 

100  CONTINUE 
C 

END 


C 

C 


C 

C 

C 


C 

c 

c 

c 

c 


SUBROUTINE  BTOR(T*BOD*REF) 

TRANSFORMS  FROM  BOD  TO  REF  FRAME  GIVEN  TRANSFORMATION  MATRIX  T 
REAL  T(3*3)*80D(3)*REF<3) 

REF(1)=B0D(1)*T(1,1)*B0D<2)*T<1,2)*80D(3)*TC1,3) 

REF<2)=BOD<1)*TC2,1)+80DC2>*T<2,2>*BODC3>*T<2,3> 

REFC3)=B00<1)*T(3*1)+B0D(2)*T(3/2)+B0D(3)*T(3*3) 

END 

SUBROUTINE  RT08  <  T, R  E  F*  BOD ) 


C-9 


C  TRANSFORMS  FROM  REF  TO  300  FRAME  6ZVEN  TRANSFORMATION  MATRIX  T 

C 

REAL  T(3/3)/REF(3)*80D(3) 

C 

BOD ( 1 )*R£F(1)*T(1r1)+REF(2)*T(2#1)*REF(3)*T(3#1) 
B0D(2)=REF(1)*T(1,2)*REF(2)*T(2,2)*REFC3)*T(3#2) 

80D(3>  =  R£F(1)*T(1*3)+REF(2)*T(2/3MREF<3)*T(3*3) 

C 

END 

C 

C 

C 

C 

SUBROUTINE  LOOK (T, XI *X2,X3*0MEGA,TIME, IBUF,CHAN#IOSB) 

€ 

C  DETERMINES  WHERE  CAMERA  IS  POINTING  (AT) 

C  FROM  MMU  POSITION  (Xl#X2sX3)  AND  TRANSFORMS 

C  FROM  RH  TO  LH  CARTESIAN  COORDINATES  (FM) 

C  FOR  VIEWING  ON  EVANS  &  SUTHERLAND  PS300. 

C  DETERMINES  UP  VECTOR  FOR  PS300  AND  ALSO  COMPUTES 

C  EARTH  AND  STAR  ROTATIONS  AND  POSITION  OF  HORIZON. 

C  INFORMATION  IS  THEN  SENT  TO  THE  PS300  FOR  DISPLAY. 

C 

INCLUDE  *  CALF AN03PR0C0NST. FOR/ NOLIST* 

REAL  CAM(3)#T(3#3)sXlsX2sX3 
REAL**  0M£GAsTIMEsUP(3) 

REAL**  TR0T,ER0T,AT(3),FM(3),UPPS(3> 

REAL**  NEWX(3)sBMAT(3s3)s8VEC(3) * AN AT (3*3) 

C 

INTEGER**  CHAN^SYSSalO, STATUS 
INTE6ER*2  I0SB(4)sIBUF(193> 

C 

C  COMPUTE  MMU  POSITION  WRT  C-W  FRAME  (IN  LH  SYSTEM) 

C 

FM (1 )*X1 
FM(2)«X2 
FM (3 ) *-X3 
C 

C  ASSIGN  VALUES  TO  CAMERA  LOOK  VECTOR  IN  BODY  FRAME 

C 

CAM(1)*1000. 

CAM(2)*0. 

CAM( 3)=0. 

C 

C  TRANSFORM  TO  REF  FRAME 

C 

CALL  BTOR (T*  C  AM# AT) 

C 

C  ADD  MMU  POSITION  TO  CAMERA  VECTOR  (REF  FRAME) 

C  ANO  CONVERT  TO  LH  SYSTEM. 

C 

AT(1 )*AT(1)*FM(1) 

AT(2)*AT(2)*FM(2) 

AT(3)*-AT(3)*FM(3) 

C 

C  ASSIGN  VALUES  TO  UP  VECTOR  IN  BODY  FRAME 

C 

UP(1)*0. 

UP (2 ) 30. 


UP(3)«-1000 


C-IO 


TRANSFORM  TO  REF  FRAME*  TRANSLATE  TO  'AT*  IN  LH  SYSTEM 

CALL  BTORCTsUPsUPPS) 

UPPS(1)=AT(1)*UPPS(1) 

UPPS (2)=AT(2)+UPPS(2) 

UPPS (3) =AT( 3) -UPPS (3) 


CONVERT  AT  *  FM 


UPPS  FROM  FEET  TO  METERS 


AT(1)=AT(1)*«3G48 
AT(2)*AT(2)*.3048 
AT(3)=AT(3)*.3048 
FM(1 )*FM(1)*.3048 
FM(2)*FM(2)*.3048 
FN(3)=FM(3)*.3048 
UPPS (1)=UPPS<1)*. 3048 
UPPS(2)=UPPS<2)*.3048 
UPPS <3>=UPPS<3>*. 3048 

DETERMINE  EARTH  ROTATION  (DE6> 

EROT=TIHE*. 0041 78075 

DETERMINE  TARGET  ROTATION  (DEG) 

TROT=ONEGA*57. 29577951 *TIME 

SEND  INFORMATION  TO  PS300 

CALL  R0T(-ER0T*2*AMAT) 

CALL  P919CV(AMAT*9*IBUF(169)) 

CALL  R0T(TR0T*3*AMAT) 

CALL  P919CV(AMAT*9*IBUF(125>) 

CALL  P919CV(AMAT*9#IBUF(147>) 

CALL  LOOKAT(AT*FM*UPPS/BMAT*BVEC> 

CALL  P91 9CV (BMAT*9* IBUF(S)) 

CALL  P919CV(BVEC*3*IBUF(25)> 

CALL  P919CV(BMAT*9*IBUF<35>) 

CALL  P919CV(BVEC*3*IBUF(55)> 

CALL  P919CV(BMAT*9*IBUF(65>) 

CALL  P919CV(BVEC*3*IBUF(85>> 

CALL  P919CV(BMAT*9*IBUF(95>> 

CALL  P919CV(BVEC*3*I3UF(115)) 

CALL  NUMBER<TIME*IBUF(191>) 

DO  A  WRITE  SYNC 

42  WRITE  SYNC  FUNCTION  CODE 

IOSB  10  STATUS  SLOCK 

IBUF  DATA  BUFFER  (ACTUALLY  ADDRESS  OF  BUFFER 

386  DATA  BYTE  COUNT  (193  WORDS) 

0  NOT  CHARACTER  DATA  (1  =  CHARACTER  DATA) 


BUFFER*  BY  REFERENCE) 


SEND  ALL  DATA 

STATUS=SYSSQI0(XVAL(1)/XVAL(CHAN)*XVAL(42)/I0SB*** 


>*> 


IBUF(1),XVAL(386),XVAL(0),,,) 

IF  (STATUS  •  NE.  1)  THEN 

TYPE  *, *  B AD  WRITE  <STATUS,IOSB>* , STATUS, IOSB 
STOP 
ENDIF 


SUBROUTINE  ROT(ANGLE,IAXIS,AMAT) 

C 

C  ROUTINE  TO  GENERATE  ROTATION  REQUESTS  TO  PS300 

C 

C  CALLING  SEQUENCE: 

C 

C  CALL  ROT(ANGLE,IAXIS,AMAT) 

C 

C  WHERE: 

C 

C  ANGLE  IS  THE  REAL*4  ANGLE  FOR  ROTATION,  IN  DE6REES.  NEED  NOT  BE  LIMITED 
C  TO  A  SINGLE  CIRCLE. 

C  I  AXIS  IS  THE  INTEGERS  AXIS  OF  ROTATION  (1=X,  2*Y,  3*Z>. 

C  ANAT  IS  THE  REAL  3X3  MATRIX  CALCULATED 

C 

C 

INTEGER*2  IAXIS,I,J 

REAL  AN6LE,AMAT(3,3),PI180 

DATA  PI180/0. 017453/ 


IDX(I)=MOD(I*2,3)+1 


!  STATEMENT  FUNCTION  (NOT  AN  ARRAY) 


IF(IAXI$.LT.1.0R.IAXIS.6T.3>  STOP  *PSLIB— AXIS  OUT  OF  BOUNDS* 

DO  10  1=1,3 

DO  10  J*1 ,3 

AMAT ( I, J ) =0. EQ 

RADIAN  *  ANGLE  *  PI180 

C*COS(RADIAN> 

S=SIN (RADIAN) 

AMAT(IAXIS,IAXIS)*1 . EO 
1= IDX (IAX IS~1 ) 

J*IDX(IAXI$+1) 

AMAT ( I, I) SC 

AMAT(J,4)*C 

AMATO, J)=S 

AMAT ( J, I) =-S 

RETURN 

END 


SUBROUTINE  P91 9CV (M ATRI X, N, BUF FER) 


C  ROUTINE  TO  CONVERT  A  VAX  REAL  ARRAY  TO  ACP  FLOATING-POINT  FORMAT 

C 

C  THIS  ROUTINE  CONVERTS  AN  ARRAY  OF  VAX  SINGLE-PRECISION  REAL  NUMBERS  INTO 
C  A  NORMALIZED  ARRAY  OF  32-BIT  ACP  MANTISSAS,  WITH  THE  ARRAY  PRECEDED  BY 
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C  A  1 6-BIT  EXPONENT.  THE  HOST  SIGNIFICANT  ELEHENT  IN  THE  ARRAY  IS  NORMAL- 
C  I Z ED. 

C 

C  FORTRAN  CALLING  SEQUENCE:  VV 

C 

C  CALL  P919CV(MATRIX*N*BUFFER> 

C 

C  WHERE: 

C 

C  MATRIX  IS  AN  N-ELEMENT  REAL**  ARRAY  OF  VAX  FLOATING-POINT  NUMBERS. 

C  N  IS  THE  INTE6ER*2  SIZE  OF  ARRAY  MATRIX. 

C  BUFFER  IS  THE  INTEGERS  ARRAY*  OF  LENGTH  2N*1*  INTO  WHICH  THE  RESULT  IS 
C  PLACED*  WITH  THE  EXPONENT  WORD  FIRST*  FOLLOWED  BY  THE  ARRAY  OF 

C  32-BIT  MANTISSAS. 

C 

C 

INTEGER*2  N*BUF F ER (2 *N+1 ) * FWORDC2) 

REAL  MATRIXCN) *DMAX 

INTEGER**  PSMEXP*PSMFRA*PSMNOR* DWORD* EDWORD 
EQUIVALENCE  C DWORD* FWOR D ( 1 ) ) 

C  FIND  LARGEST  REAL  NUMBER  TO  OBTAIN  EXPONENT 

DMAX=0. 

DO  10  1=1 *N 

10  DHAX=AMAXl(DMAX*ABS<HATRIXCI)>) 

C  USE  EXPONENT  OF  LARGEST  NUMBER  FOR  NORMALIZATION 

DWORD=PSMEXP(OMAX) 


BUFFER<1)=FW0RD(1) 

EDWORD=DWORD 

C  OBTAIN  NORMALIZED  FRACTIONS  AND  LOAD  INTO  BUFFER 

DO  20  1  =  1  * N 

DWORD=PSMNOR(MATRIX(I)*EDWORO) 

BUFFER<2*I>=FWORD<2> 

BUFFER<2*IM)*FW0RDC1> 

20  CONTINUE 

RETURN 


END 


C 

C 

C 

C 

SUBROUTINE  LOOK AT < AT*FM*UP*MAT*VEC> 

C 

C  ROUTINE  TO  GENERATE  LOOK  AT*  LOOK  FROM* 

C  LOOK  UP  REQUEST  TO  THE  PS300 

C 

C  THIS  ROUTINE  UPDATES  A  PS300  DISPLAY  LOOK  NODE 

C  WITH  THE  NECESSARY  LOOK  MATRIX 

C 

C  CALLING  SEQUENCE: 

C 

C  CALL  LOOKAT<AT*FM*UP*MAT* VEC) 

C 

C  WHERE: 

C  INDEX  IS  THE  INTEGER*2  NODE  SUFFIX  <1 <=INDEX<=256) 

C  WHICH  CORRESPONDS  TO  ONE  OF  THE  DISPLAY  STRUCTURE 

C  NODES  N001  THROUGH  N256. 

C  AT*  FM*  UP  :  ARE  THE  VIEWING  VECTORS 

C  MAT  :  IS  THE  RESULTING  3X3  VIEWING  MATRIX 

C  BUFFER  IS  THE  INTEGER*2  ARRAY*  OF  LEN6TH  2N*1* 

C  INTO  WHICH  THE  RESULT  IS  PLACED*  WITH  THE  EXPONENT 


WORD  FIRST*  FOLLOWED  BY  THE  ARRAY  OF  32-BIT  MANTISSAS 
VEC  IS  A  3  ELEMENT  ARRAY  CONTAINING  ROW  4 

COMPUTES  4X4  MATRIX  FOR  LOOK  FUNCTION 

REAL  ATC3)*FM(3)*UP(3)*MATC3*3)*TC3)*VEC(3) 

REAL  D(3)*E<3)*H*F<3)*6<3>/H(3)*MA6 

D(1)*AT(1)-FM<1) 

D<2)=AT<2)-FM<2> 

D(3)SAT(3)-FM(3) 

HAS=DO>**2*D(2)**2  +  D(3)**2 
IF  (MAG  .GT.  .IE-30)  THEN 
MAG-SGRT(MAG) 

ELSE 

MAG=. IE-30 
ENDIF 

D (1 ) aD(1) /MAG 
D(2)=D(2)/MAG 
D ( 3) =D ( 3) /MAG 

E(1)*UP(1)-AT(1) 

E(2)aUP(2)-ATC2> 

E<3)=UP(3)-AT<3) 

M*D(1 >  *E(1)+D(2)*E(2)  +  D(3)*E(3) 

FC1)*ECT)-M*D<1) 

F(2)aE(2)-M*D<2) 

F(3)*£(3)-M*0(3) 

IF  <(F(1)+F(2I*F(3))  .EQ.  O.O)  THEN 
E(1 Ja0.0 
E(2)*1.0 
E( 3) *0. 0 

F(1)3Ed)”M*D(1) 

F(2)*E(2)-M*0(2) 

F(3)*E(3)-N*DC3) 

IF  (CF(1)+F(2)+F<3)>  .EQ.  0.0)  THEN 
E(1 )*0«0 
E<2)*0.0 
E(3)=1.0 
F (1 )aE (1 )-M*D ( 1 ) 

F(2)=E(2)-M*D<2> 

F(3)aE<3)-M*D(3) 

ENDIF 

ENDIF 

MAGsSQRT(F(1)**2+F(2)**2*F(3)**2) 

G(1)=F(1) /MA6 
6( 2) *  F (2) /MAG 
6 (3) ®F ( 3) /MAG 

H(1)«G<2)*D(3)-S(3)*D(2) 

H(2)*G(3)*D(1)-G(1)*D(3) 

H(3)*GC1)*D(2)-GC2)*DC1) 


T<1)«-FH<1>*H(1>-FH<2>*M<2>-FH(3>*H<3> 
T<2>»-FH(1)*G<1>-FHC2)*G<2>-FH(3>*G<3> 
TC3)*-FH<1>  *D(1>-FH(2)*D(2>-FHC3>*D<3) 


C 


C 


C 


c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 


99 

100 


5 


1  0 


HAT { 1* 

1)* 

H(1  > 

HAT ( 1  * 

2)* 

H(2> 

HATH* 

3>a 

HC3) 

VEC  < 1 ) 

=  T<1> 

HAT  <2* 

1  )  = 

6(1 ) 

HAT  <2* 

2  )  = 

G(2) 

H AT( 2* 

3)  = 

G(  3) 

VEC( 2) 

=  T< 

2) 

HAT  C  3* 

1>* 

D  <  1 ) 

HAT  C  3* 

2)  = 

D(2) 

HAT ( 3* 

3)* 

D  (  3) 

VEC  <  3 ) 

=  T( 

3) 

RETURN 

END 


SUBROUTINE  P920CV(HAT* VEC* BUFFER) 

THIS  SUBROUTINE  FILLS  IN  A  4  X  4  ARRAY  INTO  THE  BUFFER. 
YOU  LOAD  A  3  X  4  HAT*  AND  AN  ARRAY  VECC3)  IS  THE  FOURTH 
IT  FILLS  34  ELEHENTS  IN  THE  BUFFER. 

INTEGER*2  ITEHP1<9>*  ITEHP2<25>*  BUFFER134) 

REAL  HAT < 3* 4) *  VEC <4 ) * HAT1 <4*3> 

DO  100  1*1*3 
00  99  J*1 * 4 

MAT1 ( J* I ) =HAT (I  * J ) 

CONTINUE 

CONTINUE 

CALL  P919CV(VEC*4*ITEHP1 ) 

CALL  P919CV(HAT1*12*ITEHP2) 

BUFF  ER(1  )  *  ITEMP1 <1  ) 

DO  5  I  *  1*25 

BUFFER (1+1)  =  I TEHP2  < I  ) 

CONTINUE 
DO  10  J  *  1*8 

BUFFER (J+26)  =  ITEHP1 C J*1 > 

CONTINUE 

RETURN 

END 


ROW. 


C 

c 

c 

c 


SUBROUTINE  NUHBER<X*BUFFER> 


THIS  SUBROUTINE  HILL  TAKE  ANY  NUH8ER  F R OH 
ENCODE  IT*  AND  PUT  IT  IN  THE  PROPER  PLACE 
BUFFER*  IBUF 


9999.9  TO  -999.9* 
IN  THE  OUTPUT 


INTEGERS  BUFFER(3)*  TBUF(3> 
CHARACTER**  CHAR 


LOGICAL  *1  TENP0*T£MP1(6) 
EQUIVALENCE  (CHAR/TEMPI ,T8UF> 


If (X.6T.9999.9)  X*9999.9 
If (X.LT.-999.9)  X=-999.9 
ENC0DE(6s2G1sCHAR)X 
201  FORMAT  (F6. 1 ) 

T£MP0*TEMP1 (1) 

TEMPI <1 ) =TENP1 (2) 

TEMPI (2)*TEMP0 
T£HP0=TEMP1 C  3  > 

TEMPI (3)*TEMP1 (4) 

TEMPI (4)=TEMP0 
TEMP0=TEMP1 (5) 

TEMPI (5)*TEMP1 (6> 

TEMPI <6)=TEMP0 
BUFFER(1>*TBUF<1) 

BUfFER(2>sTBUf(2) 

BUFFERC3)*T8UF<3) 

RETURN 

END 

C 

C 

C 

C 

SUBROUTINE  INITBUFCIBUFsCHANsIOSB) 

C 

C  THIS  SUBROUTINE  FILLS  IBUF  WITH  DATA  THAT  DOES  NOT  CHANGE 

C  DURING  PROGRAM.  THIS  DATA  IS  USED  TO  ADDRESS  PS300  MEMORY 

C  LOCATIONS. 

C 

INTEGERS  SYSSQIO/SYSSSETEF^SYSSWAITFR 
INTEGERS  CHANs STATU SsSYS$ASSIGNsSYS$QIOWsNAMADX( 8) 

INTEGERS  IBUF  <1 93)  /  NAMES  (  5, 8)  ,  NAN  ADR  (.2, 8)  ,  I OSB  C4  >,  8UFNUM 
CHARACTER*4  unit 
EQUIVALENCE  (NAMADRsNAMADX) 

DATA  NAMES/'TA'  .'RG*  #*T.%*LO,^,OX’^  •PL,^*BA,,'Y.  V’LO'^’OK'/' 
'GL'f’OBS’E.S'LO'/'OK'/'ST'/'AR'/'S.'/'LOS’OlC/ 
,GL,#,OB,*,E.**,TR,,,OT,,,ST,,,AR»,,S.,*,TR,,,OTV 
,GL,**OB***E.*#,ER*<’*OT,*'IN,**FO'*,.RV'TI'#,HE*/ 

DATA  UN  IT/ *  PIAO  *  / 

C 

C  WAIT 

C 

DO  3  J*1r500000 
5  CONTINUE 

C 

C  SET  UP  HOUSEKEEPING 

C 

C  GET  A  CHANNEL  NUMBER 

C 

STATUS  =  SYSSASSIGN(UNIT,CHAN^> 

IF (STATUS. NE.1)  THEN 

TYPE  *# ' B AD  ASSIGN!  <STATUS>  =  STATUS 
STOP 
ENDIF 
C 


1 

1 

1 


DETACH  FOR  SAFETY 


34  — >  DETACH  FUNCTION  CODE 


ST  ATU  S-SYSSQIOWI,  XV  AL(CHAN),XVAL<  34  ) ,I0S9,  ,,,,,,,) 


ATTACH: 


33  — >  ATTACH  FUNCTION  CODE 


ST ATUS= S Y SSOI OW(, X V AL < CH AN ),XVAL< 33), IOSB,, ,,,,,,) 
IF(STATUS.NE.I)  THEN 

TYPE  ' BAD  ATTACH!  <STATUS>  =  •, STATUS 
STOP 
ENDIF 

GET  THE  ADDRESSES  OF  THE  ENTITIES  TO  UPDATE 
43  -->  LOOKUP  NAMED  ENTITIES  FUNCTION  CODE 

DO  25  1*1,8 

STATUS=SYSSQI0WC,XVAL<CHAN),XVALC43),I0S3,,,NAMESC1,I), 
XVAL(10),XVAL(1 ),,,) 

IF(ST ATUS.EQ.1 .AND. I 0 SB (1) .EQ.1 .AND. 

(IOSB<3).OR.I05B(4)).NE.O)  GOTO  21 
TYPE  *, 'BAD  ENTITY  FETCH!  <STAT,IOSB>  —  *, STATUS, IOSB 
STOP 

GET  THE  ADDRESS  FROM  OUT  OF  THE  10  STATUS  BLOCK  (IOSB) 

DO  24  J  =1,2 

NAMADRC J,I)=I0Sa<J+2) 

CONTINUE 

CONTINUE 


OFFSET  THE  ADDRESSES  TO  GET  PAST  THE  FIRST  THREE  FIELDS 
OF  THE  NODE  WHICH  WE  DO  NOT  WANT  TO  CHANGE. 

DO  30  1=1,8 

NAHADX(I)*NAMADX(I)+8 

CONTINUE 

OFFSET  TEXT  BY  AN  ADDITIONAL  16 


NAMADX(8) =NAM ADX (8 ) ♦  1  6 


BUFFER  1  SETUP 
TRANSLATION  NEEDS  7  ELEMENTS 

ROTATION  NEEDS  19  ELEMENTS 

LOOKAT  NEEDS  28  ELEMENTS 

TEXT  NEEDS  3  ELEMENTS 


IBUFI 
IBUFi 
I8UF  i 
IBUFI 
I8UFI 
IBUFi 
IBUFi 
IBUFi 
IBUFi 
IBUF  I 


N AN AD  R  (  1  , 1  ) 
NAMADR (2,1  ) 
27 
1 

N AM AD R  < 1 , 2 ) 
NAMADRC 2,2) 
27 
1 

NAMADR(1,3) 


FIVE  8L0CKS 

BLOCK  ONE  ADDRESS  -  T ARGT . LOOK 
BLOCK  ONE  ADDRESS 
WORD  COUNT  FOR  BLOCK  1 
TRAN  FLAG 

BLOCK  TWO  ADDRESS  -  PLBAY.LO-*a 
BLOCK  TWO  ADDRESS 
WORD  COUNT  FOR  BLOCK  2 
TRAN  FLAG 

BLOCK  3  ADDRESS  -  GLOBE. LOCK 
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IBUFC63) 

* 

NAMADR (2/3) 

i 

• 

I8UFC64) 

X 

27 

i 

IBUF ( 84) 

X 

1 

; 

IBUF  <92 ) 

= 

NAHADRC1/4) 

i 

IBUFC93) 

NAMADR (2/4) 

t 

IBUF (94) 

= 

27 

» 

IBUF  < 1 1 4) 

s 

1 

t 

IBUFC122) 

s 

NAMADRC1/S) 

t 

IBUF ( 123) 

3 

NAMAD R  ( 2/ 5  ) 

« 

IBUF ( 1 24) 

s 

19 

i 

IBUF ( 144) 

= 

NAMADR (1/6) 

« 

IBUFC145) 

- 

NAMADR (2/6) 

i 

IBUF (146) 

3 

19 

i 

IBUF (166) 

3 

NAMADRC1/7) 

; 

IBUF (167) 

3 

NAMADR(2/7) 

« 

IBUF (168) 

3 

19 

i 

IBUF  Cl  88) 

s 

NAMADR ( 1/8) 

IBUF ( 1 89) 

= 

NAMADR(2/7) 

IBUF ( 190) 

3 

3 

END 

BLOCK  3  ADDRESS 

WORD  COUNT  FOR  BLOCK  3 

TRAN  FLAG 

BLOCK  4  ADDRESS  -  STARS. LOOK 
BLOCK  4  ADDRESS 
WORD  COUNT  FOR  BLOCK  4 
TRAN  FLAG 

BLOCK  5  ADDRESS  -  GLOBE. TROT 

BLOCK  5  ADDRESS 

WORD  COUNT  FOR  BLOCK  5 

BLOCK  6  ADDRESS  -  STARS. TROT 

BLOCK  6  ADDRESS 

WORD  COUNT  FOR  BLOCK  6 


BLOCK  7  ADDRESS  -  GLOBE. EROT 

BLOCK  7  ADDRESS 

WORD  COUNT  FOR  BLOCK  7 

BLOCK  8  ADDRESS  -  ONFO.RTIME 

BLOCK  8  ADDRESS 

WORD  COUNT  FOR  BLOCK  8 


SUBROUTINE  ROTATE(ANG/DELTAT/UB/Q/T) 

LINEARLY  INTEGRATES  TO  FIND  ROTATION  IN  BODY  FRAME/-  THEN 
TRANSFORMS  TO  REFERENCE  FRAME. 

REAL  ANG{3>/WaC3)/DELTAT/Q(4>/T(3/3> 

COMPUTE  BODY  RATES  <WB) 

(ANG  IS  ANGULAR  ACCELERATION) 

W8(1)*WB(1)+DELTAT*ANG(1 > 

W8(2)=WB(2)*DELTAT*ANG(2) 

WB(3)*WB(3)*DELTAT*ANG(3) 

FIND  QUATERNION  RATE  AND  INTEGRATE 

CALL  9DOT(Q/WB(1)/W9(2)/W3(3)/DELTAT) 

COMPUTE  ROTATION  MATRIX 

CALL  TRNSFM(T/Q> 

END 


SUBROUTINE  PS30Q ( ALT / I NCL  IN ) 

THIS  SUBROUTINE  IS  THE  GRAPHICS  PROGRAM  FOR  THE 


1 

t 

j 

*  -*■  ’»•*  .*  \k 

.1  fc  Jt  ■k'fc  » 
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C  MMU  SIMULATOR.  IT  GENERATES  A  TAR6ET,  ROTATING 

C  EARTH/  HORIZON  AND  STAR  FIELD  FOR  BACKGROUND. 

C  SUBROUTINE  LOOK  SENDS  NEW  DATA  TO  THIS  PROGRAM  IN 

C  THE  PS300  TO  UPDATE  TARGET  RANGE  AND  ATTITUDE  AND 

C  EARTH/STAR  ROTATIONS. 

C 

INCLUDE  1 CALFAN03 PROCONST. FOR/ NOLI  ST* 

C 

LOGI C AL*1  P0SLINC73) 

REAL*4  ALT/INCLIN/AT(3)/FM(3)/UP(3) 

REAL *4  V(3)/HORR/HORT/HORD/LONG/ANG 
INTEGER  I/NVEC 
DIMENSION  VECSC4/73) 

C 

DATA  POSL IN/ .FALSE./ 72*. TRUE./ 

C 

C  ATTACH  GRAPHICS  DEVICE  AND  INITIALIZE  GRAPHICS 

C 

CALL  PATTCH('LOGDEVNAM=PIAO: /PH YDEVT YP=PAR ALLEL * /ERR) 
CALL  PINITCERR) 

C 

C  V<3>  -  VECTOR  ARRAY  FOR  PS300 

C  HORR  -  RADIUS  OF  EARTH  HORIZON  AS  SEEN  FROM  TARGET  (M) 

C  HORD  -  DISTANCE  OF  HORIZON  FROM  EARTH  CENTER  CM) 

C  HCRT  -  DISTANCE  OF  HORIZON  FROM  TARGET  CM) 

C 

CALL  BAY 
C 

C  COMPUTE  EARTH  HORIZON  RADIUS  CHORR)/ 

C  DISTANCE  FROM  EARTH  CENTER  CHORD)CM)/ 

C  AND  DISTANCE  FROM  TARGET  TO  HORIZON  CHORT) 

C 

ALT®  ABS  CALT ) 

HORD =4 06 806 06. 08/(6378. 135*ALT) 

HORR=SQRT (40680606. 08”H0RD*H OR D) 

H0RT=H0RR*6378. 135 /HORD 
H0RD=H0RD*1 000.0 
M0RR-H0RR*1 000.0 
H0RT=H0RT*1 000.0 
C 

C  INITIALIZE  PS300  INSTANCE  NODES  AND  CONNECTIONS 

C 

V(1)=0.0 
VC  2) =0.0 
V  C  3) =0.0 
C 

ATC1 )=0.0 
AT (2 ) =0.0 
ATC3W0.0 
C 

FMC1 )=0.0 
FM(2)=0.0 
FMC3)*0.0 
C 

UPC1)*0.0 
UP (2 )*1 0. 0 
UP(3)=0.0 
C 

CALL  PBEGSC' INFO*/ERR) 

CALL  PSEDCL(’CLIP,/.FALSE./*"*/ERR) 


w 


l 


\ 


CALL  PVI£«P(,",/-1./1.»*1./1./1./1./,M/E«R) 

CALL  PWIND0(*WNDy*/0./ 80.* 0., 80. /0./1 00./"**/ ERR) 
CALL  PLOOK A ( *  LOOK  *  /AT/FM/UP/ ""/ERR) 

CALL  PSECHW(*“'/'"*/ERR) 

CALL  PCRSCAC*"*/!  ■  / 1  ./'"'/ERR) 

CALL  PCH$('*"/0«/79./1./1»/0./*USAFA  ASTRO  LAB'/ERR) 
CALL  PCHS<*"*/0«/75./1«/1./0«/'TIHE  (SEC)*/ERR) 

CALL  PCHS  <*RTIME*/1  2. /75./1.  /1./G./*  000000*  /ERR) 

CALL  PENDS(ERR) 

CALL  P8£GS(*TARGT*/ERR) 

UNITS  IN  METERS 

CALL  PSEDCLt'CLIP*  /. TRUE.  /**"/  ERR) 

CALL  PV  IE  UP  C*"*/-1. 0/1. 0/-1. 0/1. 0/1. 0*1.0*  •"•/ERR) 
CALL  PFOV(""/35.0/1.0/H0RT/""/ERR) 

CALL  PLOCKAC  LOOK '/AT/FM/UP/ ""/ERR) 

CALL  PINSTC,"**,SMUTTLE*^£RR> 

CALL  PENDS (ERR) 

BUILD  A  SPACE  SHUTTLE 

CALL  VECT0R('RHING'/5) 

CALL  PBEGSC  SHUTTLE* /  ERR) 

V(1)*1 .395 
V(2)=1 .395 
V(3) =1 «  395 

CALL  PSCALE(""/V/""/ERR) 

CALL  PROTX(""/-90.0/""/ERR) 

CALL  PR0TY<",,/“2.0/*"*/ERR) 

VC1)=-19. 

V(2)*0«0 
V<3) =-2. 35 

CALL  PTRANS(""/V/""/ERR) 

CALL  PINST(""/*DOOR*/ERR) 

CALL  PIN$T(**"/*RWING*/ERR) 

CALL  PINSTC""/'RMAIN*/ERR) 

CALL  PINST(""/*CMAIN*/ERR> 

V(1)=1.0 
VC2)=-1.0 
V( 3) *1 .0 

CALL  PSCALE(""/V/ *DOOR*/ERR) 

CALL  PSCALE<*"'/V/*RWING*/ERR> 

CALL  PSCALE(*"*/V/ *RMAIN*/ERR) 

CALL  PENDS(ERR) 

BUILD  THE  RIGHT  MAIN  ENGINE 

CALL  PBEGS('RMAIN*/ERR) 

V< 1 )  =  2. 8 
V<2)*1.0 
V ( 3 ) “1 . 5 

CALL  PTRAN$(""/V/""/ERR) 

CALL  PROTY<""/10.0/*"*/ERR> 

CALL  PR0TZ<*"*/-5.0/ 'ENGINE* /ERR) 

CALL  PENDS ( ERR) 

BUILD  A  CENTER  ENGINE 

CALL  PBEGS(*CMAIN*/ERR) 

V<1)=3.2 


non  onnon  on  n  non 
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V(2)*0.0 
V(3)=3. 6 

CALL  PTRAN$(*,**/V/*,"/ERR> 

CALL  PR0TY(**'*/15.Q/*EN6INE,/ERR)  * 

CALL  PENDS ( ERR) 


BUILD  A  MAIN  ENGINE 

CALL  P9EGS( ' ENGI NE * / ERR) 

CALL  PSEC0L(****/120.0/.8/,,**/ERR) 
CALL  PROTZ<*M,/-90.0/*,,*/£RR) 
V(1)=0.0 
V(2)=-2. 5 
V(3>=0.0 

CALL  PTRANS('"%V#'"'/ERR) 
V<1>=1.0 
V<2)*2. 5 
V ( 3 )  =  1 -  0 

CALL  P$CAL£(*'*,/V/,*"/ERR) 

CALL  PINSTC***,/*HENI,/ERR) 

CALL  PROTXC  *" *  /“90 .0/  *SEMI*/ERR) 
CALL  PROTX<,"*,90.0,*SEHI,*ERR> 
CALL  PENDS(ERR) 

BUILD  A  MOVABLE  DOOR 

CALL  VECTOR  CRDOOR*  #5) 

CALL  P8EG$C*D00R*/£RR) 

V(1 )=19.0 
V<2)=1.9 
V<3)32. 35 

CALL  PTRANSe^/V/'-'/ERR) 

CALL  PR0TY(*"'/2.0/'"*/ERR> 

CALL  PR0TX<*0PEN'/-140.0/**"/ERR> 
CALL  PROTY(**,,/-2.0/,"*/ERR> 
V<1)*-19.0 
V  C  2 ) =~1 . 9 
VC3>***2. 35 

CALL  PTRANS(,"'/V/,RDOOR*/ERR) 
CALL  PENDSCERR) 


COMMANDS  FOR  DOOR  OPENING 

SEND  LABEL  TO  DIAL  AND  DECLARE  ROTATE  FUNCTION 

CALL  PFN< 'DOORROT* /*  XROTATE'/ERR) 

CALL  PSNST<*DOOR*/1/'DLABEL8*/ERR) 

CONNECT  INPUTS  TO  ACCUMULATOR 

CALL  PFNC  ACC  8* /'ACCUMULATE* /ERR) 

C 

CALL  PC ONNC* DIALS' /8/1 /' ACC  8*/ ERR) 

CALL  PSNREAC-U0./2/ '  ACC8*/ERR) 

CALL  PSNREAC1./3/' ACC8'/ERR) 

CALL  PSNREAC-15./4/' ACC8*/ERR) 

CALL  PSNREA CO./S/' ACC8 '/ERR) 

CALL  PSNREA(-140./6/ * ACC8*/ERR) 

C 

CALL  PCONN<'ACC8*/1/1/*DOORROT*/ERR) 


C-2  I 


CALL  PCONN<*DOORROT*#1#t#*DOOR.OPEN,#ERR) 

C 

C 

C  CREATE  A  SPINNING/ INCLINED  GLOBE  OF  THE  EARTH# 

C  SET  IT  COUNTER-ROTATING  W.R.T.  TARGET  ORBIT. 

C  ADD  A  STATIONARY  HORIZON 

C 

CALL  PBEGSC  GLOBE*  sERR) 

CALL  PSED CL< *  CLIP*#. TRUE. #*"*# ERR) 

CALL  PVIEWPC  *"' #“1 .0#1.0#-1.0#1.0#1.0#1.0#*"*#ERR> 
CALL  PFOV<* "*#35.0# ALT* 1 00.0# H0RT+2000Q0.0# *" * #ERR> 
CALL  PL00KA< *  LOOK*  #AT#FN#UP#*"* # ERR) 

V<1>*0.0 

V< 2) *<-6378. 135-ALT) *1000.0 
V(3)*0. 0 

CALL  PTRANS(***'#V#*"*#ERR) 

CALL  PINSTC****#*HORIZON*#ERR) 

CALL  PROTZ(*TROT*#O.0#**,*#ERR) 

CALL  PSEC0L<*"*#240.#1.#*"*#ERR) 

CALL  PR0TX<*"»#9G.-INCLIN#*",#ERR> 

CALL  PR0TY<*ER0T»#0.0#****#ERR) 

V(1 >*6378135. 

V(2)*V<1) 

V(3)*V(1) 

CALL  PSCALE<*"*#V#****#ERR) 

CALL  PINST<*"*#*WORLD*#ERR> 

CALL  PSECOL(*"*#240.#0.0#*’**#ERR) 

CALL  PINSTC*"*#' SPH£R£*#ERR> 

CALL  PINST<*"*#*LATLINE*#ERR> 

CALL  PENDS(ERR) 

C 

C  CREATE  A  HORIZON  F ROM  A  CIRCLE 

C 

CALL  PBEGS<*HORIZON*#ERR) 

V<1)=0.0 
V<2)=H0RD 
V(3)*0. 0 

CALL  PTRANS<****#V#*"*#ERR> 

CALL  PROTX(,,**#90.#*"*#ERR) 

V  < 1 ) *HORR 
V(2)*H0RR 
V(3)*H0RR 

CALL  PSCALE<*"*#V#*CIRCLE*#ERR> 

CALL  PENDS(ERR) 

C 

C  CREATE  A  STAR  FIELD  AND  SET  IT 

C  COUNTER-ROTATING  W.R.T.  TARGET  ORBIT 

C 

CALL  PBEGSC* STARS* #ERR) 

C  UNITS  ARE  IN  METERS 

CALL  P$EDCLC*CLIP'#.TRUE.#*"*#ERR> 

CALL  PVIEyP<*"*#-1 .0#1.0#-1.0#1.0#1.0#1.0#*"*#ERR) 
HORT=HORT*900.*SQRT<<2.*ALT+6378.)**2-6378.**2) 
CALL  PFOVC"*# 35.0#.  1  *HORT#HORT#  * " * # ERR) 

CALL  PLOOKA<*LOOK*#AT#FM#UP#  **,*#ERR> 

V<1 )*0.0 

V< 2 >*-63781 35. 0-ALT*1 000.0 

V  <  3 ) *0. 0 

CALL  PTRANS(**"#V#**,*#ERR) 

CALL  PR0TZ(*TR0T*#0.0#*"*#ERR) 
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CALL  P$£C0L(,*'**180.*0.**',**ERR) 

CALL  PR0TZ("*'*180.*,STARS.TWINKLE**ERR> 

CALL  PR0TY(,’***18Q.*'STARS.TWINKLE**ERR> 

V<1 >=6378135. 0*ALT*2000.0  >V 

V<2>=V<1> 

V(3)=V(1 > 

CALL  PSCALE(*TWINKL£'*V**STAR**ERR} 

CALL  PENDS ( E  RR) 

C 

C  BUILD  A  SPHERE  FROM  A  CIRCLE 

C 

CALL  PBEG$(*SPHERE**ERR) 

DO  200  L0NG=1 0* 1 80/10 

CALL  PROTY(*"**LONG*,CIRCLE,*ERR) 

200  CONTINUE 

CALL  PENDS(ERR) 

C 

C 

C  BUILD  A  HEMISPHERE  FROM  A  SEMI-CIRCLE 

C 

CALL  PBEGS((HEMI*/ERR) 

DO  222  L0NG=15*180*15 

CALL  PROTY(,"**LONG/*SEMI'*ERR) 

222  CONTINUE 

CALL  PENDS(ERR) 

C 

C 

C  COMPUTE  LINES  OF  LATITUDE  USING  CIRCLES 

C 

CALL  PBEGSC'LATLINE^ERR) 

CALL  PR0TX(,,,**9Q.0*,CIRCLE**£RR> 

CALL  PROTX(,"**90.0**LAT**ERR) 

CALL  PROTX<*"'*-90.0**LAT**ERR> 

CALL  PENDS ( ERR) 

C 

C 

CALL  PBEGSCLAT’/ERR) 

DO  20  1=10*80*10 

A NG=I*. 0174532925 
V<1 )=0.0 
V(2)=0.0 

V(3)=SIN(ANG)-SIN(ANG-. 174532925) 

CALL  PTRANS(*"**V**"**ERR) 

Vd)-COS(ANG) 

VC2)=V<1) 

V (3)=0.0 

CALL  PSCALE<***'*V** CIRCLE* *ERR) 

20  CONTINUE 

CALL  PENDSCERR) 

C 

C 

C  VECTOR  LIST  FOR  CIRCLE 

C 

DO  10  1=1*73 

ANG=5.0*< 1-1 >*.01 745 32925 

VEC$(1*I)=C9S(ANG)  -r* 

VECS<2*I)=SIN(ANG)  -V>; 

VE  C  S  <  3* I ) =0.0 
VECS<4*I)=1.0 
CONTINUE 


10 
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NVEC  *73 

CALL  PVC8EG('CIRCLE*#NVEC#.TRUE.#.FALSE.#3#PVITEH#ERR) 
CALL  PVCLIS<NVEC#VECS#POSLIN#ERR) 

CALL  PVCENO (ERR) 


VECTOR  LIST  FOR  SEMI-CIRCLE 
DO  12  1*1  #1  3 

ANG*<-90.0+15.0*<I-1))*.017*532925 
VECS<1# I)*SIN(ANG) 

VECS(2#I)*C0S(ANG) 

VECS ( 3# I) *0.0 
VE  CS  <4# I) *1 .0 
CONTINUE 

NVEC*1 3 

CALL  PVC8£G<*SEMI,#NVEC#.TRUE.#.FALSE.#3#PVITEM#ERR) 
CALL  PVCLI$<NVEC#VECS#POSLIN#ERR) 

CALL  PVCENO (ERR) 


CALL  NEEDED  VECTOR  LISTS 

CALL  VECTOR  <*U0RLD*#5) 
CALL  VECTOR  C'STAR*#*) 

DISPLAY  ALL 

CALL  PDISP<*INFO'#ERR) 

CALL  PDISP<*TARGT«#ERR) 
CALL  PDISP<'GL08E'#ERR) 
CALL  PDISP<'PLBAY*#ERR) 
CALL  PDISP<'STARS*#ERR) 


DETACH  GRAPHICS 


CALL  PDTACH (ERR) 


SUBROUTINE  VECTOR  (NAME#LENGTK) 

THIS  SUBROUTINE  READS  A  VECTOR  LIST  FROM  VAX 
FILE  AND  PUTS  IT  IN  USABLE  FORM  FOR  THE  PS300 

INCLUDE  • CALFANOlPROCONST. FOR/NOLIST* 

INTEGER**  IPOS#  LENGTH#  CLASS 
REAL**  POINTS  <*#2000) 

LOGICAL*!  POSLIN  <2000)#  PL#  VL 
CHARACTER  NA«E*8#  F ILENAME*26 

FILENAME*' CALF ANO. DATA 3* //NAME <:LENGTH>// * .DAT* 
OPEN  <  UNIT*1 #  N AME=F I LENAME#TYPE=* OLD*# READONLY) 
READ  <  1#  910)  VL# IPOS 
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910  FORMAT  <  A1/I10) 

IF  ((VL.£0.*C*)  .OR.  ( VL. EO. *C ' ) )  THEN 
CL  ASS  =0 

ELSE  IF  ( (VL. EO. *  0  * )  .OR.  (VL  .EO.,0,)>  THEN 
CLASS=1 

ELSE  IF  ( (VL. EQ. ' I ' )  .OR.  (VL  .EQ.*I*))  THEN 
CLASS=2 

ELSE  IF  ( (VL. EQ. *  S * )  .OR.  (VL  .EQ.*S*)>  THEN 
CL ASSs3 
ENOIF 

00  3410  I=1/IP0S 

READ  (  1/  911)  PLs(P0INTS(K*I)/Ks1/3) 

911  FORMAT  (  A1 r  3F12.8) 

POINTS  (4/I>=1 
POSLIN(I)=. FALSE. 

IF  ( (PL.EQ. 'L*  )  .OR. (  PL. EQ. *L* ) )  POSLIN(I)*.TRUE. 

3410  CONTINUE 

CALL  PVC3EG  ( NAME (: LENGTH) / IPOS/ . FALSE. /. FALSE. / 3/ CLASS/ ERR) 
CALL  PVCLIS  (IPOS/POI NT S/POSL IN/ERR) 

CALL  PVCENO  (ERR) 

CLOSE  (UNIT *1 ) 

END 

C 

C 

C 

C 

SUBROUTINE  UNITIZE(V) 

C 

C  UNITIZES  V  VECTOR 

C 

REAL  V<3) #MAGV 
C 

IF  ( ABS (V(1 ) )  .LT.  .IE-10)  V(1>*. IE-10 
IF  ( ABS (V (2) )  .LT.  .IE-10)  V(2)=. IE-10 
IF  ( ABS  (V ( 3) >  .LT.  .IE-10)  V(3)=. IE-10 
MAGV»$QRT(V(1)*V(1)+V(2)*V(2)+V(3)*V(3)) 

V(1)*V(1)/MAGV 

V(2)*V(2)/MAGV 

V(3)*V(3)/MAGV 

C 

ENO 

C 

C 

C 

C 

SUBROUTINE  CROSS(A/B/C> 

C 

C  COMPUTES  A  *  B  X  C 

C 

REAL  A( 3) /S ( 3) /C ( 3) 

C 

A(1)«9(2)*C(3)-B(3)*C(2) 

A(2)=B(3)*C(1)-B(1)*C(3> 

A(3)-B(1)*C(2)-B(2)*C(1) 

C 

C 
C 
C 
C 


ENO 


noon 


SUBROUTINE  QDOT(Q*WX*WY*WZ*DELTAT) 

C 

C  FIGURES  QUATERNION  RATE  CQD)  AND  LINEARLY  INTEGRATES 

C  FOR  TINE  STEP  OELTAT. 

C 

REAL  Q(4)*QD(4)*WX*WY*WZ*DELTAT*CONST 
INTEGER  J 
C 

QO<1)*CQ<2)*WZ-a<3)*«Y+QC4)*WX)*.5 
QDC2)=(-a<1)*WZ+Q(3)*UX+Q(4)*WY)*.5 
QD<3)  =  <Q(1)*WY-Q(2>*WX«-QC4>*WZ>*.5 
QO<4)a(-Q(1)*UX-Q<2)*WY-Q<3>*WZ)*.5 
C 

00  100  J=1*4 

Q(J)=Q(J>+DELTAT*QD< J> 

100  CONTINUE 
C 

C  NORMALIZE  QUATERNIONS 

C 

C0NSTaSQRT(Q<1)*Q(1)+Q(2)*QC2)*Q<3>*QC3)^Q<4)*Q<4)) 
Q(1)=Q(1)/C0NST 
Q(2)SQ(2) /CONST 
Q<3)  =*Q(3)/C0N$T 
QC4)»Q«4)/C0NST 
C 

END 


SUBROUTINE  TRNSFM(T*Q) 

COMPUTES  TRANSFORMATION  MATRIX  CT)  FROM  QUATERNIONS  CQ) 
REAL  T (3*3) *Q(4) 

T(1*1)»Q(1)*Q(1)-Q(2)*Q(2>-Q(3>*QC3)+a(4)*Q(4) 

T(2*1)=2.0*(Q(1)*Q(2)+Q(3)*Q(4>) 

T(3*1)=2.0*(Q(1)*Q(3)-Q(2)*a(4>) 

T(1*2)*2.0*(a(1)*Q(2)-Q(3)*a(4)) 

T(2*2)*-Q(1)*a(1)+Q(2>*Q(2>-Q(3>*B(3>+a(4}*aC4) 

T<3*2)=2.0*(Q(2)*Q(3)+Q(1)*Q(4)> 

T(1*3)=2.0*(a(1)*a(3)+Q(2)*Q(4)) 

T(2*3)*2.0*(Q(2)*a(3)-Q(1)*Q(4)) 

T(3*3>*-a(1)*a(1)-a(2)*Q(2)*Q(3)*Q(3)+Q(4)*Q(4) 

END 


SUBROUTINE  IOBUFF  ( I FUNC * C *RESET> 

INTEGER  S(24)*L(24)*C(12) 

INTEGER  I FUNC*R£SET 
INTEGERS  DATAOUT* DATA  IN 
INTE6ER*2  0 IBUF ( 1 0 ) * OOBUF ( 1 0) 
INTEGERS  I  ST  AT* IC  ALL 
INTEGERS  NCHAN*OOFLAG*OIFLAG 
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REAL  ARATE/RATE 

DATA  D0FLAG/DIFLAG/3/5Z 
DATA  NF RAHE/10/ 

OATA  HODEOUT/NODEIN/8/7/ 

DATA  IUNIT/1 / 

DATA  ICHAN/1 / 

DATA  NCHAN/1/ 

DATA  ISHODE/O/ 

DATA  INIT/1/ 

DATA  RATE/80000.0/ 

GO  TO  (100/200)  IFUNC 

100  CALL  LPAIO  (INIT/IUNIT//RATE/////ARATE/ISTAT/ICALL##) 

IF  (.NOT.  ISTAT)  GO  TO  950 
RETURN 

200  CONTINUE 

DATAOUT**  0000*  X 
DO  210  1=1 *6 

210  DATAOUT =D AT A0UT*LCI)*2**CI“1 ) 

DO  220  I=1/NFRANE 

220  DO0UFCI)  =  DATAOUT  .XOR.  *  FFFF  *  X 

CALL  LPAIO  (NODEOUT/IUNIT/DOFLAG//ICHAN/NCHAN/NFRAHE/DOBUF// 

1  ISTAT/ICALL//ISMODE) 

IF  {.NOT.  ISTAT)  GO  TO  950 
CALL  SYSSWAITFR  { XVAL {DOF L AG ) ) 

230  CALL  LPAIO  {1 8/////////ISTAT/ICALL/LSTAT/ ) 

IF  {(ISTAT. NE.-1). AND. {LSTAT.NE. 1 > >  GO  TO  230  ■ 

CALL  LPAIO  (NODEIN/IUNIT/DIFLAG//ICHAN/NCHAN/NFRANE/DIBUF// 

1  ISTAT/ICALL//ISMODE) 

IF  (.NOT.  ISTAT)  GO  TO  950 
CALL  SYSSWAITFR  (XVAL(DIFLAG) ) 

240  CALL  LPAIO  (1 7,, , ,,, ,, / 1ST AT, IC ALL/LSTAT/ ) 

IF  ( (ISTAT. NE.-1 ). AND. (LSTAT.NE. 1))  GO  TO  240 
DATAIN=(DIBUF(1).X0R.*FFFF,X) 

S(1)=DATAIN  .AND.  1 
S(2)=(DATAIN  .AND.  2)/2 
S(3)=(DATAIN  .AND.  4)/4 
S(4)=(DATAIN  .AND.  8)/8 
S(5)=(DATAIN  .AND.  16)/16 
S ( 6)  =  (D AT  A I N  .AND.  32)/32 
RESET=( (64.X0R.DATAIN)  .AND.  64)/64 
DATAOUT=*4000*X 
DO  250  1=7/15 

250  DATAOUT=DATAOUT*L(I) *2** (I “7) 

DO  260  I=1/NFRAHE 

260  DOBUF (I)  =  DATAOUT  .XOR.  *  F  F  FF  *  X 

CALL  LPAIO  (W0DE0UT/IUNIT/D0FLAG//ICHAN/NCHAN/NFRAME/D08UF// 

1  ISTAT/ICALL//ISNODE) 

IF  (.NOT.  ISTAT)  GO  TO  950 
CALL  SYSSWAITFR  (XVAL (DOFLAG) ) 

270  CALL  LPAIO  (18/////////ISTAT/ICALL/LSTAT/) 

IF  ((ISTAT. NE.-1). AND. (LSTAT.NE. 1))  GO  TO  270 

CALL  LPAIO  (HODEIN/IUNIT/DIFLAG//ICHAN/NCHAN/NFRAME/DIBUF// 

1  ISTAT/ ICALL//ISMODE) 

IF  (.NOT.  ISTAT)  GO  TO  950 
CALL  SYSSWAITFR  ( X V AL ( D I FL AG ) ) 
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v\. 


AND. 

8)  /  8 

AND. 

16) /1 6 

AND. 

32)/32 

AND. 

64)/64 

AND. 

1 2  Q ) / 1 28 

AND. 

256) /2  56 

280  CALL  LPAIO  (17/,/,///// ISTAT/ICALL/LSTAT,) 

IF  ((ISTAT. NE.-1). AND. (LSTAT.NE.1))  60  TO  280 
DATAINa(DI3UF (1 ) . X  OR. * F  F F  F  *  X) 

S(7)=DATAIN  .AND.  1 
S ( 8)  =  (D AT  AI N  .AND.  2)/2 
S(9)=(DATAIN  .AND.  4)74 
S(10)=(DATAIN 
S( 1 1 ) = ( D ATA IN 
S(12)=(DATAIN 
S( 13)*(DATAIN 
S(14)=(DATAIN 
S(15)=(DATAIN 
DATA0UT='8000*X 
DO  290  1=16/24 

290  DATACUT=DATAOUT*L(I) *2**(I~16) 

DO  300  1=1 /NFRAME 

300  DOBUF(I)  =  DATAOUT  .XOR.  *  F F F F  *  X 

CALL  LPAIO  (MODEOUT,IUNIT,DOFLAG,,ICHAN,NCHAN, NFRAME, DOBUF,, 
1  ISTAT/ICALL//ISMODE) 

IF  (.NOT.  ISTAT)  GO  TO  950 
CALL  SYSSWAITFR  (XVAL(DOFLAG) ) 

310  CALL  LPAIO  (1 8// // // // / I STAT/ I C ALL/LSTAT/ ) 

IF  ((ISTAT. NE.-1). AND. (LSTAT.NE.1))  GO  TO  310 

CALL  LPAIO  (MODEIN/I UNIT/ DI FLAG// I CHAN/NCH AN, NFRAME/ DIBUF// 

1  ISTAT, IC ALL/ /ISNODE) 

IF  (.NOT.  ISTAT)  GO  TO  950 
CALL  SYSSWAITFR  ( X V AL ( D I FL AG) ) 

320  CALL  LPAIO  (1 7// ,,,,,,, 1ST AT/ IC ALL/LSTAT, ) 

IF  ((ISTAT. NE.-1). AND. (LSTAT.NE.1))  GO  TO  320 
DATAIN=(0 IBUF ( 1 ) . XOR . * F FF F ' X ) 

S(16)=DATAIN  .AND.  1 
S( 1 7)  =  (DAT  A  IN 
S(18)*(DATAIN 
S(19)=(DATAIN 
S(20)*(DATAIN 
S ( 21 ) = (D ATAIN 
S(22)*(DATAIN 
S(23)*(DATAIN 
S(24)=(DATAIN 
DATAOUT=,COOO'X 
DO  340  1=1 /NFRAME 

340  DOBUF(I)  =  DATAOUT  .XOR.  *  F  F  FF  *  X 

CALL  LPAIO  (FIODEOUT,IUNIT,DOFLAG,,ICHAN,NCHAN, NFRAME, DOBUF,, 
1  ISTAT/1CALL//ISM0DE) 

IF  (.NOT.  ISTAT)  GO  TO  950 
CALL  SYSSWAITFR  ( XV AL (DOFL AG ) ) 

350  CALL  LPAIO  (18///////// ISTAT ,IC ALL/LSTAT/) 

IF  ((ISTAT. NE.-1). AND. (LSTAT.NE.1))  GO  TO  350 

CALL  LPAIO  (HODEIN/IUNIT, DIFLAG, /ICHAN/NCHAN, NFRAME, DIBUF,, 

1  ISTAT, ICALL//ISMODE) 

IF  (.NOT.  ISTAT)  GO  TO  950 
CALL  SYSSWAITFR  (XVAL(DIFLAG) ) 

360  CALL  LPAIO  ( 1 7/ ,,,,,,,, I  ST  AT, I C ALL/LSTAT/ ) 

IF  ((ISTAT. NE.-1). AND. (LSTAT.NE.1))  GO  TO  360 
DATAIN=(DIBUF(1).X0R.,FFFF*X) 

C(1)=(1.X0R.DATAIN)  .AND.  1 


AND. 

Z)  12 

AND. 

4  )  /  4 

AND. 

8)  /  8 

AND. 

1 6) /I  6 

AND. 

32)/32 

AND. 

64)/64 

AND. 

128)7128 

AND. 

256)7256 

C(2)=((2.X0R. 

C(3)=(0ATAIN 

C(4)*(DATAIN 

C(5)=(DATAIN 


DATAIN)  .AND. 
.AND.  4)/4 
.AND.  8 ) / 8 
.AND.  1 6) / 1 6 


2  )  /  2 


C- 28 


C  <  6) * (DAT  AIN  .AND.  32)732 
C ( 7)  =  (DAT  AIN  .AND.  64)764 
C  (  8  )  = (DAT AIN  .AND.  1 28) /I  28 
C<9)=<DATAIN  .AND.  256)/256 
C( 10)=(DAT AIN  .AND.  5123/512 
C<11 )  —  < DAT  AIN  .AND.  1024)71024 
C  < 1 2) * ( DATA  IN  .AND.  2048)72048 
RETURN 

950  CONTINUE 

WRITE  <5*1950)  I S  T  AT/ I  CALL 

1950  FORMAT  <’  ERROR  IN  CALL:  STATUS  =  ,/I6/t  FROM  CALL  **/I6> 

CALL  EXIT 
END 
C 
C 
C 

c 

SUBROUTINE  BAY 
C 
C 

C  THIS  ROUTINE  BUILDS  THE  PAYLOAD  BAY  ON  THE  PS300 

C  ALL  DIMENSIONS  ARE  IN  FEET. 

C 

INCLUDE  •CALFAN03PR0C0NST.F0R/N0LIST* 

C 

RE AL*4  V ( 3) /L0NG/AT(3)/FH(3)/UP(3) 

REAL  INCR/SCL 
C 
C 

ATC1  )  =  0.0 
AT (2 ) =0.0 
AT  <3)  =  20. 0 
C 

FM  (1  )  =  0.0 
FM<2 )=0.0 
FM<3)=0.0 
C 

UP  Cl )  =  0.0 
UPC2 )=1 0. 0 
UPC3)=0.0 
C 

CALL  PBEGSC'PLBAY'/ERR) 

CALL  PSEDCLC CLIP* /.TRUE./* "'/ERR) 

CALL  PVIEWP<*"'/-1 .0/1 .0/- 1.0/1 .0/1.0/ 1.0/'"'/ ERR) 

CALL  PFOV (•"*/ 35.0/1 ./I  0000. 0/'"*/ ERR) 

CALL  PLOCKAC*LOOK*/AT/FM,UP/"**/ERR> 

V<1 )=.3048 
V(2)=.3048 
V(3)=.3048 

C  SCALE  FROM  FEET  TO  METERS 

CALL  PSCALE<»"*/V/ ,*’»/ERR) 

VCD  =-30. 

V<2)=“1 2.0 

V ( 3 ) =0. 0 

CALL  PTRANS<'H,/V/*"*/ERR)  _ 

CALL  PSEC0L<'"'/300./1.0/,,"/ERR) 

CALL  PINST  (*'*•/  •  PAYLOAD*  /  ERR) 

CALL  PSEC0L<*",/180./1.0/,",/ERR) 

CALL  PINSTC*’*/*  SHOULDER*/ERR) 


ft  n  n  m  n  n  n  w  n  noon 
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CALL  PSEC0L(*”a#90.#1.0*taaa#ERID 
CALL  PINST<*"*/*BOX*/ERR) 

■>\v.  CALL  PENDS(ERR) 


SCALE  SATELLITE  AND  ROTATE  IT  TO  LIE  OH  Z  AXIS 

CALL  PBEGS(*PAYLOAD*/ERR) 

CALL  PSEC0L(**,*/240./1.0/*"*/ERR) 

VCD*-20.0 
V<2>=0.0 
V(3)*0. 0 

CALL  PTRAN$(*'**/V/*,**/ERR> 

VC1)=0.0 
VC  2) *C. 0 
VC3>*0.0 

CALL  PTRAHS<*TRAN*/V»"**#ERR) 

CALL  PR0TZ<'",/90./'"'/ERR) 

VCD*. 5 
VC2)=VC1 ) 

VC3)*V<1 ) 

CALL  PSCALEC’-DV/’-DERR) 

00  335  L0NG=1 0/360/1 0 

CALL  PROTX<**,,<’LONG^*RTDRS,/ERR) 

CONTINUE 
CALL  PENDS ( ERR) 

BUILD  A  CYLINDER 

CALL  PBEGSC* CYLINDER* /ERR) 

DO  333  L0NG*36/360/36 

CALL  PROTYC*"*/LONG/*RCYL»/ERR) 

CONTINUE 
CALL  PENDSCERR) 

BUILD  A  BOX 

CALL  P8EGS<*B0X*/ERR) 

V<  D  =  0.  0 

V  <  3)  =  0. 0 
V<2)*4.0 

CALL  PTRANS<'"*/V/*RECT*/ERR) 

V  <  2) *6. 0 

CALL  PTRAN$C***/V/»RECT*/ERR) 

V(2)*8.0 

CALL  PTRANS<*"'/V/*RECT*/ERR) 

V<2)*10.0 

CALL  PTRANSC'-’/V/'RECT'/ERR) 

V(2>*12.0 

CALL  PTRANS<""/V/*RECT*/ERR) 

CALL  PENDS(ERR) 

BUILD  A  RECTANGLE 

CALL  PBEGS(*RECT*/ERR) 

V ( D  *  30. 

VC2)=0. 

V<3)*9.0 

CALL  PSCALE<*"*/V/*SQUARE'/ERR) 

CALL  PENDSCERR) 


or><~»  onn  r»  n  r»  r* 


m 


CALL  NEEDED  VECTOR  LISTS 

CALL  VECTOR  C'RCYL*/4) 

CALL  VECTOR  C'RTDRS*  ,5) 
CALL  VECTOR  C*SQUARE*/6) 

INCR=.3 
SCL=-5. 0 


BUILD  A  WRIST 

CALL  PBEG$C'WRIST'/ERR) 

CALL  PROTXC'PITCH'/O.O/  "**/ERR) 
VCD  =  .5415 
VC2)=1 . 23 
VC3)=.5415 

CALL  PSCALEC^'/V/'CYLINDER'/ERR) 
VCD=0.0 
VC2)=1 . 23 
VC  3 )  =  0. 0 

CALL  PTRANSC,"*,V/,"',ERR> 

CALL  PR0TZC'YAW*/0.0/*’**,ERR> 

CALL  PROTYC'RGLL'/O.G/'-'/ERR) 
VCD*. 5415 
VC2)=4-93 
VC3)=.5415 

CALL  PSCALEC*"',V/ * CYLINDER* /ERR) 
CALL  PENDS ( ERR ) 

BUILD  A  FOREARM  <W/  ELBOW) 

CALL  PBEGSC* ELBOW* , ERR) 

V(1 )*0-0 
V(2)=0.0 
VC3)=.5415 

CALL  PTRANSC**'*/V/*,,*/ERR) 

CALL  PR0TXC*PITCN*,0.0/'"*/ERR) 

V (1 )=0.0 
VC2)*0.0 
V<3)=-.5415 

CALL  PTRANSC*"*/V, ’"DERR) 

VCD  =  .5415 
VC2)=23. 1625 
VC3)=.5415 

CALL  PSCALEC’"*xV/' CYLINDER' /ERR) 
V ( 1 )  =  0.0 
VC2)=23.1625 
V  <  3 ) =0. 0 

CALL  PTRANSC*"'/V/*WRIST*/ERR) 
CALL  PENDS ( ERR) 

BUILD  THE  SHOULDER 


CALL  PBEGSC 'SHOULDER*/ ERR) 

CALL  PR0TX(*M*/-90./ '"'/ERR) 
VCD-25. 0 
V  C  2 ) *-7  . 5 
VC3)=11 .2 


o  rt  r>  r>or»r»or>  <-*<■>«  r»  o  o  r*  r»r>r>r>r»o 
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CALL  PTRANS<*TRAN**V**"**ERR> 

,  V-  CALL  PROTZ<*"*/90.0, ‘"‘/ERR) 

'yV>  CALL  PROTY(*M**180«0/**,**ERR) 

^  CALL  PR0TZ(*YAW*#0«0*'”*/ERR) 

V<1 i=0.0 
V(2)*0.0 
V<3)=-0.001 

CALL  PTRANS<**"#V/,",^ERR> 

CALL  PR0TX(*PITCH,*0«0*"*,#£RR) 
V<1>=.5415 
V<2)=20.921 
V(3)*.541 5 

CALL  PSCALE(*"**V**CYLINDER**ERR) 
V<1)*0.0 
V(2)=20.921 
V (3)*0. 0 

CALL  PTRAN$<*"*/V/*ELBOW**ERR) 
CALL  PENOS(ERR) 


COMMANDS  FOR  WRIST  ROLL 

SEND  LA8EL  TO  DIAL  AND  DECLARE  ROTATE  FUNCTION 

CALL  PFN('WRROLL*y * Y ROTATE* , ERR) 

CALL  PSNST <  *  WR  ROLL* #1** DLABELl * ,ERR> 

CONNECT  INPUTS  TO  ACCUMULATOR 

CALL  PFN(*ACC1*#*  ACCUMULATE*  *ERR) 

CALL  PCONN(*DIALS**1*1#*ACC1**ERR) 

CALL  PSNREA<0.G,Z#'ACC1*,ERR> 

CALL  PSNREA(INCR,3**  ACC1 ’/-ERR) 

CALL  PSNREA(SCL*4*'ACC1**ERR) 

CALL  PSNREA(447«0,5,*ACC1**ERR> 

CALL  PSNREA(”447«0*6**ACC1**ERR) 

CONNECT  ACCUMULATOR  OUTPUT  TO  ROTATE  FUNCTION  AND  THEN  TO  PR06RAM 

CALL  PCONNC  *  ACC1 **1*1/ *WRRCLL**ERR) 

CALL  PCONNC *WRR0LL*/ 1*1, ‘WRIST. ROLL **ERR> 


COMMANDS  FOR  WRIST  YAW 

SEND  LABEL  TO  DIAL  AND  DECLARE  ROTATE  FUNCTION 

CALL  PFN<*URYAW***ZROTATE'*ERR> 

CALL  PSNST  <  *  WR  Y  AW  *  *  1 *  *  DLABEL2  '  *  ERR) 

CONNECT  INPUTS  TO  ACCUMULATOR 

CALL  PFN<* ACC2*** ACCUMULATE* *ERR> 

CALL  PCONN(*DIALS**2*1**ACC2**ERR) 

CALL  PSNREACO.O^Z^'ACCZ'^ERR) 

CALL  PSNREA(INCR*3**ACC2*/ERR) 

CALL  PSNREA(SCL*4*’ACC2**ERR) 

CALL  PSNREA(12G.0*5*'ACC2'*ERR) 
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C 

c 

c 


c 

c 

c 

c 

c 

c 


c 

c 

c 

c 


c 

c 

c 


c 

c 

c 

c 

c 

c 


c 

c 

c 

c 


c 

c 

c 


c 

c 

c 

c 

c 


CALL  P$NREA<-120.0/6/'ACC2'/ERR> 

CONNECT  ACCUMULATOR  OUTPUT  TO  ROTATE  FUNCTION  AND  THEN  TO  PRO/>N 

CALL  PCONN('ACC2',1,1,'WRYAW',ERR> 

CALL  PCONNC 'WRYAW'*1*1»*WRIST.YAW'/ERR) 


COMMANDS  FOR  WRIST  PITCH 

SEND  LABEL  TO  DIAL  AND  DECLARE  ROTATE  FUNCTION 

CALL  PFN(*WRPITCH*#'XROTATE'/ERR) 

CALL  PSNS T<  *  WR  PITCH •, 1, ' DLABEL3 ** ERR) 


CONNECT  INPUTS  TO  ACCUMULATOR 

CALL  PFN< 'ACC  3' /'AC CUMULATE** ERR) 

CALL  PC0NN('DIALS*#3#1*'ACC3'/ERR> 
CALL  PSNREA(0.0#2*'ACC3'/ERR) 

CALL  P$NR£A(INCR/3*'ACC3*#ERR) 

CALL  PSNREA«SCL*4,'ACC3*/ERR) 

CALL  PSNREA(120.0#5**ACC3**ERR) 
CALL  PSNREA('"120«Q#6**ACC3*/ERR) 


CONNECT  ACCUMULATOR  OUTPUT  TO  ROTATE  FUNCTION  AND  THEN  TO  PROGRAM 


CALL  PCONN('ACC3'r1#1**WRPITCH**iERR) 

CALL  PCONNC  URPXTCH*  *1*1#' WRIST. PITCH*# ERR) 


COMMANDS  FOR  ELBOW  PITCH 

SEND  LABEL  TO  DIAL  AND  DECLARE  ROTATE  FUNCTION 

CALL  PFNCELPITCHVXROTATEVERR) 

CALL  PSNSTC  *  EL  P ITCH* , 1 * • DLABEL4 *, ERR) 

CONNECT  INPUTS  TO  ACCUMULATOR 

CALL  PFN<* ACC4'*' ACCUMULATE* ^ ERR) 

CALL  PCONNC 'DIALS ',4,1, *ACC4', ERR) 

CALL  PSNREA<0.0,2,  *ACC4',ERR) 

CALL  PSNREA(INCR*3**ACC4*#ERR) 

CALL  PSNREACSCL#4#'ACC4**ERR) 

CALL  PSNREA(160.0*5#*ACC4',ERR> 

CALL  PSNREAC-2.0,6,' ACC4'#ERR) 

CONNECT  ACCUMULATOR  OUTPUT  TO  ROTATE  FUNCTION  AND  THEN  TO  PROGRAM 

CALL  PCONNC 'ACC 4', 1,1, ' EL PITCH '# ERR) 

CALL  PCONNC 'ELP ITCH'  ,\ ,1,*  ELBOW. PITCH*  , ERR) 

COMMANDS  FOR  SHOULDER  YAW  .T’ 

■/V.- 

SEND  LABEL  TO  DIAL  AND  DECLARE  ROTATE  FUNCTION 
CALL  PFNC'SHYAW',' ZROTATE',ERR> 
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CALL  PSNST ( *  SH  YAW*,1,*DLABEL5*,£RR) 

CONNECT  INPUTS  TO  ACCUMULATOR 

CALL  PFN<*ACC5*,* ACCUMULATE* ,ERR> 

CALL  PCONNC* DI ALS*, 5,1,* ACCS *,ERR) 

CALL  PSNREA(0.0,2,*ACC5',ERR> 

CALL  PSNR£A(INCR,3,' ACC5*,ERR) 

CALL  PSNR£A(SCL,4,*ACC5*,ERR) 

CALL  PSNREA(180.0,5,*ACC5*,ERR) 

CALL  PSNREA<-180«0,6,*ACC5*,ERR) 

CONNECT  ACCUMULATOR  OUTPUT  TO  ROTATE  FUNCTION  AND  THEN  TO  PROGRAM 

CALL  PCONN(*ACC5*,1,1,*$HYAW*,ERR) 

CALL  PCONNC'SHYAW*, 1,1, 'SHOULDER. YAW*, ERR) 

COMMANDS  FOR  SHOULDER  PITCH 

SEND  LABEL  TO  DIAL  AND  DECLARE  ROTATE  FUNCTION 

CALL  PFN(*SHPITCH*,*XROTATE',ERR) 

CALL  PSNSTC  *  SH  PITCH*, 1,*0LABEL6*, ERR) 

CONNECT  INPUTS  TO  ACCUMULATOR 

CALL  PFNCACC6*, 'ACCUMULATE*, ERR) 

CALL  PC  ON NC* DIALS', 6/1, *ACC6', ERR) 

CALL  PSNREA<0.C,2,'ACC6*,ERR> 

CALL  PSNREACINCR,3,' ACC6*,ERR> 

CALL  PSNREA(SCL,4,*ACC6*,ERR) 

CALL  PSNREA(2.0,5,'ACC6*,ERR) 

CALL  PSNREAC-145.0,6,* ACC6*,ERR) 

CONNECT  ACCUMULATOR  OUTPUT  TO  ROTATE  FUNCTION  AND  THEN  TO  PROGRAM 

CALL  PCONNC* ACC  6', 1,1,* SHP ITCH*, ERR) 

CALL  PCONNC *SHP ITCH*, 1,1, 'SHOULDER. PITCH*, ERR) 

COMMANDS  FOR  SATELLITE  TRANSLATION 

SEND  LABEL  TO  DIAL  AND  DECLARE  VVECTOR  FUNCTION 

CALL  PFNC*SATRAN',*YVECTOR*,ERR) 

CALL  PSNSTC  *SAT  TR AN ' , 1, * DLABEL7* , ERR) 

CONNECT  INPUTS  TO  ACCUMULATOR 

CALL  PFNC* ACC 7*, 'ACCUMULATE*, ERR) 

CALL  PCONNC ' D I AL S * ,7, 1 , ' AC C7*, ERR) 

CALL  PSNREACO.0,2,' ACC7*,ERR) 

CALL  PSNREA(.05,3,'ACC7',ERR) 

CALL  PSNREAC2.0,4,*ACC7',ERR> 

CALL  PSNREAC100.0,5,'ACC7*,ERR) 

CALL  PSNREAC0.0,6,*ACC7',ERR) 

CONNECT  ACCUMULATOR  OUTPUT  TO  YVECTOR  FUNCTION 


_•  '  «  *_«  '  j-  V*  -  *  »  *  •*'** 
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C  AND  THEN  TO  PROGRAM 

C 

CALL  PCONN('ACC7**1*1**SATRAN*#ERR) 

CALL  PCONNCSATRAN*, 1,1,' PAYLOAD.  TRAN*  *ERR> 
C 

END 
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<<<  LP  A 1 0  >»>  LPA11-K  I/O  ROUTINES;  J.M.  LINO;  03  NAY  83;  REV  C 

SUBROUTINE  LPAIO  (MODE, IUNIT, IFLAG, DRATE, ICHAN,NCHAN,NFRAME, IOBUF, 

1  ARATE,ISTAT,ICALL,LSTAT,ISMODE) 

REV  A  DESIGNED  TO  USE  AST  CALLS  AT  COMPLETION  OF  SWEEP  (FILE  NAME  LPAIOA, 

REV  8  MODIFIED  TO  USE  EVENT  FLAGS  INSTEAD  OF  AST  CALLS  03  FEB  83  ( JHL) 

REV  C  MODIFIED  TO  ADD  I/O  MODE  CALLING  PARAMETER  "ISNOOE"  AND  TO  ALLOW 

FOR  2  CHANNEL  DIGITAL  I/O  WITH  THE  ADDITION  OF  NODES  7,8*17,  ft  18. 

CALLING  SEPCIFICATIONS: 


MODE 


I  UNI  T 


I  FLAG 

DRATE 

ICHAN 

NCHAN 

N  FRAME 

IOBUF 


MODE  OF  CALL  WITH: 

MODE  =  1  INITIALIZE  LPA11-K  UNIT  IUNIT 
=  3  ANALOG  INPUT 
=  4  ANALOG  OUTPUT 
=  5  DIGITAL  INPUT  A 
=  6  DIGITAL  OUTPUT  A 
=  7  DIGITAL  INPUT  8 
=  3  DIGITAL  OUTPUT  9 
=13  ANALOG  INPUT  STATUS 
=14  ANALOG  OUTPUT  STATUS 
=15  DIGITAL  INPUT  STATUS  A 
=16  DIGITAL  OUTPUT  STATUS  A 
=17  DIGITAL  INPUT  STATUS  B 
=13  DIGITAL  OUTPUT  STATUS  8 

UNIT  NUMBER  OF  THE  DESIRED  LPA11  SUBSYSTEM: 

IUNIT  =  0  USES  LA AO: 

=  1  USES  LA80: 

NUMBER  OF  THE  EVENT  FLAG  WHICH  IS  TO  BE  SET  A  COMPl 

DESIRED  SAMPLE  RATE  (DO  NOT  EXCEED  80  KHZ) 

START  CHANNEL  NUMBER 

NUMBER  OF  CHANNELS  (MUST  BE  1  FOR  DIGITAL  I/O) 

NUMBER  OF  FRAMES  (NCHAN  PER  FRAME) 

BUFFER  FOR  DATA  (NFRAME  *  NCHAN  2  BYTE  WORDS  LONG) 


RETURNED  INFORMATION: 


ARATE  ACTUAL  SAMPLE  RATE  USED  (0  FOR  ERROR) 
ISTAT  THREE  WORD  ARRAY  WITH: 


ISTAT  =  0 
=  1 
=  X 


ERROR  IN  CALL 
SUCCCESFUL 
VMS  ERROR  CODE 
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LSTAT  INTEGER*!  (BYTE)  VARIABLE  USED  WITH  ISTAT  TO  DEE  IN 


ISTAT  LSTAT 


MEANING 


ICALL 


C  NOTES: 
C 


C  WARNINGS: 
C 


0  0  NORMAL  -  BUFFER  0  DONE 

-1  1  SWEEP  TERMINATED  OK 

-1  X  X  =  LPA11  ERROR  CODE  (USER'S  GO  PG 

CALL  NUMBER  OF  THIS  PROGRAM  (RELATES  TO 
LPA11  I/O  FUNCTION  WHICH  WAS  LAST  USED  BEFORE 
RETURN  TO  THE  CALLING  PROGRAM) 

IF  ICALL  =  0,  THEN  MODE  IS  UNDEFINED! 


ISMODE  SPECIFY  MODE  OF  LPA11  SWEEP 


FOR  MODES  5  -  8  (DIGITAL  I/O)*  NCHAN  MUST  BE  1. 

CHANNEL  NUMBERING  ALWAYS  STARTS  WITH  0. 

IN  MODE  Is  THE  SAMPLE  RATE  OF  THE  LPA11  CLOCK 
IS  SETs  AND  THE  SAME  RATE  IS  USED  ON  ALL  LPA11  FUNCTIONS. 
DRATE  MUST  NOT  EXCEED  80  KHZ.  HOWEVERs  THE  LPA11  USER'S 
MANUAL  SPECIFIES  MAXIMUM  AGGREGRATE  THROUGHPUT  FOR  MULTIREt 
ACTIVITIES  AT  IS  KHZ  FOR  ALL  OPERATIONS  COMBINED.  (PARA  2 .< 

WE  SPECIFYING  ISMODE  =  512  IN  THE  DIGITAL  INPUT  MODEs 
ONLY  ONE  CHANNEL  OF  DIGITAL  I/O  CAN  BE  USED  AT  A  TIME. 
OTHERUISEs  THE  PROGRAM  WILL  HANG  WAITING  FOR  THE  INPUT 
FLAG  TO  BE  SET  BY  THE  LPA11.  WHEN  USING  ONLY  ONE 
CHANNEL  OF  DI6ITAL  I/Os  THE  ISMODE  =  512  WILL  WORK 
PROPERLY.  IF  ISMODE  =  0  IS  SPECIFIED  FOR  BOTH  DIGITAL. 
INPUT  CHANNELSs  THEN  TWO  CHANNELS  MAY  BE  USED  AT  THE 
SAME  TIME.  - 

WHEN  USING  A/0  OR  D/A  MODEs  YOU  MUST  SPECIFY  AN  ISMODE 
OF  64  IN  ORDER  TO  USE  THE  MULTIREQUEST  MICROCODE  WHICH 
IS  LOADED  BY  THIS  ROUTINE. 


C  1.  IN  THE  CASE  OF  DIGITAL  OUTPUTs  THE  MODE  OF  THE  LPA11  IN 

C  RUNNING  THE  DR11-K  IS  TO  START  OUTPUT  IMMEDIATELY  (THE  MODE  SPEICIFED 
C  IN  THE  CALL  SHOULD  BE  ISMODE  =  0.) 

C 

C  2.  IN  THE  CASE  OF  DIGITAL  INPUTs  THE  MODE  OF  THE  LPA11  IN 

C  RUNNING  THE  DR11-K  IS  TO  START  INPUT  ON  EXTERNAL  TRIGGER  (THE  MODE 
C  SPECIFIED  IN  THE  CALL  SHOULD  BE  ISMODE  =  512).  THE  "EXTERNAL" 

C  TRIGGER  IS  ACTUALLY  THE  DR11-K  "EXTERNAL  DATA  READY"  LINE  FOR  THE 
C  EXTERNAL  DEVICE.  (SEE  DR11-K  TIMING  DIAGRAM  ON  PAGE  4-7  OF  THE 
C  DR11-K  INTERFACE  USER'S  GUIDE  AND  MAINTENANCE  MANUAL.) 

C  IN  THIS  MODEs  INTERRUPT  WILL  OCCURR  ONLY  AFTER  THE  EXTERNAL  DEVICE 
C  CYCLES  THE  "EXTERNAL  DATA  READY"  LINE. 

C 

C  3.  NOTE  THAT  THE  CONFIGURATION  OF  THE  DR11-K  JUMPERS  IS  VERY 

C  IMPORTANT  TO  PROPER  OPERATION  OF  THE  DR11-K.  IN  PARTICULARS  ALL 
C  SI  AND  S  2  SWITCHES  SHOULD  BE  OFF  TO  DISABLE  INTERRUPT  BY  TRANSITION 
C  OF  THE  DATA  BITS  (SEE  TABLE  5-3).  IN  ADDITIONS  JUMPERS  W5  -  W20 
C  MUST  BE  IN  POSITION  "B"  IN  ORDER  TO  READ  DATA  DIRECT  FROM  THE  DATA  w 
C  INPUT  LINES  (AS  OPPOSED  TO  THE  BUFFER  REGISTER  INPUT).  THIS  IS  TUP. 

C  DUE  TO  THE  FACT  THAT  IN  "BUFFER  REGISTER"  MODEs  THE  INDIVIDUAL 
C  DATA  BITS  IN  THE  BUFFER  ARE  SET  ONLY  ON  TRANSITION  OF  THE  DATA  LINE 
C  (SEE  PARAGRAPH  4-6  OF  DR11-K  INTERFACE  USER'S  GUIDE).  SINCE 


C  ALL  SWITCHES  ON  SI  AND  S2  ARE  OFF*  THE  STATE  OF  JUMPERS  W1-W4  IS  A 
C  DON'T  CARE.  JUMPERS  W21-W23  SHOULD  BE  SET  FOR  APPROPRIATE  POLARITY 
C  OF  THE  INTERNAL  DATA  ACCEPT  AND  INTERNAL  DATA  READY  LINES. 

C 

C  4.  REM8ER  THAT  ON  DIGITAL  OUTPUT/  THIS  PROGRAM  SPECIFIES  AT 

C  LEAST  A  150  MICROSECOND  DELAY  BEFORE  OUTPUT  OF  THE  FIRST  DIGITAL  WORD 
C  (SEE  PAGE  2-14  OF  THE  LPA1 1  USER'S  GUIDE).  THIS  IS  NECESSARY 
C  IN  ORDER  TO  ALLOW  TIME  FOR  THE  LPAll  TO  RETRIEVE  DATA  FROM 
C  MEMORY. 


C-38 


C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 
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c 

c 

c 

c 


c 


c 

c 


PARAMETER  USAGE 


MODE  IUNIT  I  FLAG  ORATE 


ICHAN  NC HAN  NFRAME  IOBUF  ARATE 


X 
X 
X 
X 
X 
X 
X 

13 

14 

15 

16 
17 
1  8 


1  X 

3  X 

4  X 

5  X 

6  X 

7  X 

8  X 


X  X 

X  X 

X  X 

X  X 

X  X 

X  X 

X 

X 

X 

X 

X 

X 


*****  PROGRAM  DECLARATIONS  ***** 


VARIABLE  DEFINITION  SECTION 

IOBUF  DATA  BUFFER  AREA  CINTEGEft*2> 

XYBUF  LPA11  CONTROL  BLOCK  (50  LONGWORDS) 

XYSTAT  LPA11  COMPLETION  STATUS  (FORM  LPASIGTBUF  CALL) 

IF  LAG  LPA11  FLAG  TO  8E  SET  AT  COMPLETION  OF  SWEEP 

XYI0S8  I/O  STATUS  BLOCK  FOR  LPA11  (4  WORDS) 

DXIOSZ  I/O  STATUS  BLOCK  FOR  DIGITAL  I/O  TO  BUFFER  Z  (CH  A  OR  B> 
XYMSKB  LPA11  SUBSYSTEM  MASKS  AND  NUM  BUFFER 

ISTAT  LPA11  STATUS  LONGWORD  ^0 

LSTAT  LPA11  I/O  COMPLETION  STATUS  BYTE 

NBUF  NUMBER  OF  BUFFERS  TO  BE  FILLED  (LONGWORD) 


WHERE  "X Y" 


IS  AD 

FOR 

ANALOG- 

TO-DIGITAL 

DA 

FOR 

DIGITAL 

-TO-ANALOG 

D I 

FOR 

DIGITAL 

INPUT 

DO 

FOR 

DIGITAL 

OUTPUT 

VARIABLE  TYPE  SPECIFICATIONS 


REAL 

LPASXRATE 

INTEGER*4 

SYSSCLREF 

INTEGERS 

I0BUF(1)sADI0SB(4)sDAI0SB(4) 

INTEGER*? 

DIIOSA(4)sDOIOSA(4)sDIIOSB(4)sDOIOSB(4) 

INTEGER*4 

ADMSKB(2)sDAMSK8(?) 

INTEGER*4 

0INSKA(2)<D0M$KA(2),DIMSK9(2),D0MSK3(2) 

INTEGER*4 

ISTAT^BUFNUFUNBUF^IFLAG 

BYTE 

IDSC^IEMC/'LSTAT 

INTEGER*? 

IDSW/IEMW 

SET  AREA  FOR  CONTROL 

INTEGER*4 

ADBUF (50)*DABUF (50) 

INTEGER*4 

DIBUFA(50)/D08UFA(50)xDIBUFB(50)^D0BUF3<50) 

EQUIVALENCE 

(AD  10  SB  (Dr  ADBUF  (1  )  )  ,  (  D  AIO  S3  ( 1 )  ,  D  ABUF  ( 1  >  ) 

r 

EQUIVALENCE 

(DIIOSA(I)^DIBUFA(I  )  )  ,  (  DO  10  S  A  ( 1  >  /■  DOBU  F  A  ( 1  )  ) 

-\V  ' 

EQUIVALENCE 

(DIIOSB(I)^DIBUFB(I)  ),  ( DO 1 0 SB ( 1 ) /•  DOBUF 3 ( 1 )  ) 

C 

C 


c  *****  START  OF  PROGRAM  ***** 

C  DETERMINE  MODE 
C 

C  LSTAT  =  0 

GO  TO  <100* 50*300/400/5 00/600/700*800/ 50*5  0*50/50* 

1  1300, 1400/ 1500, 1600,1 700* 1800) /MODE 
C  EXECUTION  STARTS  HERE  IF  MODE  IS  UNDEFINED 
50  ICALL  =  0 

ISTAT  =  0 
GO  TO  1950 
C 
C 

C  *****  MODE  =  1  ***** 

C  LOAD  LPA11  SPECIFIED  8Y  IUNIT  WITH  MICROCODE  FOR  MULTIREQUEST  MODE 
C 

100  CONTINUE 

ICALL  =  101 

CALL  LPASLOADMC  <1 , 1 UNIT, I  ST AT , I ERROR) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  USE  XR AT E  ROUTINE  TO  CALCULATE  RATE  AND  PRESET  VALUES  FOR  CLOCK  A 
C 

C  RATES  ARE  SUPPLIED/RETURNED  BUT  LPASXRATE  REQUIRES  INTERVALS 
AINTRVL  *  1./DRATE 
ICALL  =  102 

ACTUAL  =  LPASXRATE  (AINTRVL, IRATE, IPRSET/O) 

ARATE  =  1. /ACTUAL 
C 

C  SET  CLOCK  RATE  TO  SPECIFIEC  SAMPLE  RATE  (DO  NOT  EXCEED  ABOUT  80  KHZ) 
C 

ICALL  *  103 

CALL  LP ASCLOCK A  ( I R A TE , IPR SET, I  ST AT, IUNI T) 

GO  TO  1950 
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c  *****  MODE  ■  3  ***** 

C  START  ANALOG-TO-DIGITAL  INPUT  SWEEP 

300  CONTINUE  >V 

C  vv 

C  CLEAR  A/D  EVENT  FLAG 
ICALL  =  300 

ISTAT  =  SYSSCLREF  (%VAL(I FLAG) ) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  INITIALIZE  ADBUF  ARRAY  FOR  SWEEP 
C 

ICALL  =  301 

CALL  LPASSETI8F  (ADBUFsISTATsADHSKBsIOBUF) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  SET  UP  FOR  LPA11  SUBSYSTEM  NUMBER 
C 

ICALL  *  302 

CALL  LPASLAMSfCS  (ADMSKB#  IUNIT) 

C 

C  RELEASE  THE  BUFFER  (BUFFER  NUMBERS  ARE  USED  RATHER  THAN  NAMES) 

C 

ICALL  =  303 

CALL  LPASRLSBUF  ( A  DBUF# I  ST  AT#0) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  START  A/D  SWEEP  BY  SPECIFYING  ONLY  ONE  BUFFER 
C 

NP 01  NT  =  NFRAME  *  NC HAN  f.  V. . 

C  SPECIFY  ONLY  ONE  BUFFER  TO  BE  FILLED 
NBUF  =  1 

C  IN  REV  C  OF  THIS  ROUTINE#  ISMODE  IS  SPECIFIED  IN  THE  CALLING  PARAMETERS 
C  PROCEED  WITH  SWEEP  START  CALL 

C  SWEEP  CALL  SPECIFIES  FLAG  BE  SET  AT  COMPLETION 
ICALL  =  304 

CALL  LPASADSWP  ( ADBUF#NPOINT#NBUF# ISMODE##ZVAL(IFLAG)##ICHAN# 

1  NCHAN#ISTAT) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 
C 

C  RETURN  TO  CALLING  PROGRAM  ...  ISTAT  IS  STATUS  OF  A/D  SWEEP  CALL 
GO  TO  1950 
C 


c  *****  MODE  =  4  ***** 

C  START  DIGITAL-T0- ANALOG  OUTPUT  SWEEP 
C 

400  CONTINUE 
C 

C  CLEAR  0/A  EVENT  FLAG 
ICALL  *  400 

ISTAT  =  SYSSCLREF  ( XVAL ( I  FLAG) ) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  INITIALIZE  OABUF  ARRAY  FOR  SWEEP 
C 

ICALL  *  401 

CALL  LPASSETI8F  (DABUF#ISTAT#DAMSKB#IOBUF) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  SET  UP  FOR  LPA11  SUBSYSTEM  NUMBER 
C 

ICALL  *  402 

CALL  LPASLAMSKS  (0 AMSKB# IUNIT) 

C 

C  RELEASE  THE  BUFFER  (BUFFER  NUMBERS  ARE  USED  RATHER  THAN  NAMES) 

C 

ICALL  =  403 

CALL  LP ASRLSBU F  (DABUF#ISTAT#0) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  CALCULATE  NUMBER  OF  DATA  POINTS 
NPOINT  *  NFRANE  *  NC HAN 
C  SPECIFY  ONLY  ONE  BUFFER  TO  BE  FILLED 
NBUF  *  1 

C  IN  REV  C  OF  THIS  ROUTINE#1  ISMODE  IS  SPECIFIED  IN  THE  CALLING  PARAMETERS 
C  IN  D/A  MODE#  A  DELAY  OF  A  LEAST  150  MICROSECONDS  MUST  BE  SPECIFIED  BEFORE 
C  THE  FIRST  CONVERSION  TAKES  PLACE.  SINCE  THE  LPASXRATE  CALL  RETURNS  THE  V 
C  OF  IRATE  (SPECIFYING  A  CLOCK  RATE)#  LDELAY  (THE  DELAY  IN  IRATE 
C  UNITS  BEFORE  FIRST  SAMPLE)  IS  SET.  (PARA  2.4.1  OF  LPA11  USER'S  GUIDE) 

C  IRATE  *  1  FOR  1  MHZ/  IRATE  =  2  FOR  100  KHZ;  IRATE  =  3  FOR  1CKHZ#*  ETC. 
LDELAY  =  1 

IF  (IRATE. EQ.1)  LDELAY  =  150 
IF  (IRATE. E9. 2)  LDELAY  =  15 
IF  (IRATE. EQ. 3)  LDELAY  =  2 
C  SPECIFY  SAMPLE  ON  EVERY  CLOCK  OVERFLOW 
IDWELL  *  1 

C  PROCEED  WITH  SWEEP  START  CALL 

C  SWEEP  CALL  SPECIFIES  FLAG  BE  SET  AT  COMPLETION 
ICALL  *  404 

CALL  LPASDASWP  (D ABUF#NPO I  NT #NBUF# I SMODE# I  DWELL#* VAL ( I FL AG) # 

1  LDELAY#ICHAN#NCHAN#ISTAT) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 
C 

C  RETURN  TO  CALLING  PROGRAM  ...  ISTAT  IS  STATUS  OF  D/A  SWEEP  CALL 
GO  TO  1950 
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C 

c 

c 

c 

c 


c 

c 


c 

c 

c 


c 

c 

c 

c 

c 

c 

c 


c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 


*****  mode  =  5  ***** 

START  DIGITAL  INPUT  SWEEP  FOR  "CHANNEL  A" 

500  CONTINUE 

CLEAR  DIGITAL  INPUT  EVENT  FLAG 
ICALL  =  500 

ISTAT  =  SYSSCLREF  (XVAL(IFLAG) ) 

IF  (.NOT.  ISTAT)  GO  TO  1950 

CHECK  THAT  NCHAN  IS  EQUAL  TO  ONE 
ISTAT  *  0 
ICALL  *  501 

IF  (NCHAN. NE.1)  GO  TO  1950 
ISTAT  =  1 

INITIALIZE  DIBUFA  ARRAY  FOR  SWEEP 
ICALL  =  502 

CALL  LPASSETIBF  (D IBUF A, I  ST AT,D IMSKA, IOBUF ) 
IF  (.NOT.  ISTAT)  GO  TO  1950 


SET  UP  FOR  LPA11  SUBSYSTEM  NUMBER 

SPECIFY  START  WORD  CHANNEL  OF  CHANNEL  ZERO  (I/O  GUIDE  PAGE  5“22) 
IDSC  =  0 

SPECIFY  EVENT  MARK  WORD  CHANNEL  OF  CHANNEL  0 
IEMC  =  0 

SPECIFY  DIGITAL  START  WORD  MASK  OF  ALL  BITS 
ID  SW  =  -1 

SPCEIFY  EVENT  MARK  WORD  MASK  OF  ALL  BITS 
I E  MW  *  -1 
ICALL  =  503 

CALL  LPASL AMSK S  ( D IM SK A, IUNI T, , I DS C *  I EMC , I DS W, I EM W, ) 
RELEASE  THE  BUFFER  (BUFFER  NUMBERS  ARE  USED  RATHER  THAN  NAMES) 


ICALL  =  504 

CALL  LPASRLSBUF  (DIBUFA, ISTAT, 0) 

IF  (.NOT.  ISTAT)  GO  TO  1950 

START  DIGITAL  INPUT  SWEEP  BY  SPECIFYING  ONLY  ONE  BUFFER 

FOR  THIS  MODE,  THE  NUMBER  OF  POINTS  MUST  EQUAL  NUMBER  OF  FRAMES 
NPOINT  *  NFRAME 

SPECIFY  ONLY  ONE  BUFFER  TO  BE  FILLED 
NBUF  =  1 

IN  REV  C  OF  THIS  ROUTINE,  ISMODE  IS  SPECIFIED  IN  THE  CALLING  PARAMETERS 
PROCEED  WITH  SWEEP  START  CALL 

SWEEP  CALL  SPECIFIES  FLAG  BE  SET  AT  COMPLETION 
ICALL  =  505 

CALL  LPASDISWP  (01 BUF A,NPO INT, NBUF , I SMOD E, ,XVAL ( I FL AG) ,, 

1  ICHAN, NCHAN, ISTAT) 

IF  (.NOT.  ISTAT)  GO  TO  1950 


RETURN  TO  CALLING  PROGRAM  ...  ISTAT  IS  STATUS  OF  DIGITAL  INPUT  SWEEp£'£. 
GO  TO  1950  Co// 


n  n  n  o  r>  o  o  o  o  o  o  r>  r> 
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C  *****  MODE  =  6  ***** 

C  START  DIGITAL  OUTPUT  SWEEP  FOR  "CHANNEL  A" 

C 

600  CONTINUE 
C 

C  CLEAR  OIGITAL  OUTPUT  EVENT  FLAG 
ICALL  =  600 

ISTAT  =  SYSSCLREF  (XVALCIFLAG) ) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  CHECK  THAT  NC HAN  IS  EQUAL  TO  ONE 
ISTAT  =  0 
ICALL  =  601 

IF  (NCHAN.NE.1)  GO  TO  1950 
ISTAT  *  1 

INITIALIZE  DOBUFA  ARRAY  FOR  SWEEP 
ICALL  =  602 

CALL  LPASSETIBF  (D0BUFA#ISTAT#D0NSKA#I03UF) 

IF  (.NOT.  ISTAT)  GO  TO  1950 

SET  UP  FOR  LPA11  SUBSYSTEM  NUM8ER 

SPECIFY  START  WORD  CHANNEL  OF  CHANNEL  ZERO  (I/O  GUIDE  PAGE  5-22) 

IDSC  =  0 

SPECIFY  EVENT  HARK  WORD  CHANNEL  OF  CHANNEL  0 
IE  HC  =  0 

SPECIFY  DIGITAL  START  WORD  MASK  OF  ALL  BITS 
IDSW  =  -1 

SPCEIFY  EVENT  MARK  WORD  MASK  OF  ALL  BITS 
I E  MW  =  -1 
ICALL  *  603 

CALL  LPASLAMSKS  (DOMSKA#IUNIT##IDSC#IEMC#ID$W#IEMW#) 

RELEASE  THE  BUFFER  (BUFFER  NUMBERS  ARE  USED  RATHER  THAN  NAMES) 

ICALL  *  604 

CALL  LPASRLSSUF  (D08UFA#ISTAT#0) 

IF  (.NOT.  ISTAT)  GO  TO  1950 

FOR  THIS  MODE#  THE  NUMBER  OF  POINTS  MUST  EQUAL  NUMBER  OF  FRAMES 
NPOINT  =  NFRAME 

SPECIFY  ONLY  0*'c  BUFFER  TO  BE  FILLED 
N8UF  =  1 

IN  REV  C  OF  THIS  ROUTINE#  ISMODE  IS  SPECIFIED  IN  THE  CALLING  PARAMETERS 

IN  DO  MODE#  A  DELAY  OF  A  LEAST  150  MICROSECONDS  MUST  BE  SPECIFIED  BEFORE 
THE  FIRST  CONVERSION  TAKES  PLACE.  SINCE  THE  LPASXRATE  CALL  RETURNS  THE  V\ 
OF  IRATE  (SPECIFYING  A  CLOCK  RATE)#  LDELAY  (THE  DELAY  IN  IRATE 
UNITS  8EF0RE  FIRST  SAMPLE)  IS  SET.  (PARA  2.4.1  OF  LPA11  USER'S  GUIDE) 
IRATE  =  1  FOR  1  MHZ;  IRATE  =  2  FOR  100  KHZ)  IRATE  =  3  FOR  1CKHZ)  ETC.  i 
LDELAY  *  1 

IF  (IRATE. EQ.1)  LDELAY  =  150 
IF  (IRATE. EQ. 2)  LDELAY  =  15 
IF  (IRATE. EQ. 3)  LDELAY  =  2 
SPECIFY  SAMPLE  ON  EVERY  CLOCK  OVERFLOW 
IDWELL  *  1 

PROCEED  WITH  SWEEP  START  CALL 


j 


r»  n  n  n  n  n  o  oooo  oon  o  o  r»  n  o  n  n  non 


c  *****  MODE  *  7  ***** 

C  START  DIGITAL  INPUT  SWEEP  FOR  "CHANNEL  B" 

C 

700  CONTINUE 
C 

C  CLEAR  DIGITAL  INPUT  EVENT  FLAG 
ICALL  =  700 

ISTAT  =  S YSSCLREF  (XVAL ( I  FLAG) ) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  CHECK  THAT  NCHAN  IS  EQUAL  TO  ONE 
ISTAT  =  0 
ICALL  =  701 

IF  (NCHAN. NE.1)  GO  TO  1950 
ISTAT  =  1 

INITIALIZE  DIBUFB  ARRAY  FOR  SWEEP 
ICALL  =  702 

CALL  LPASSETI9F  (DI8UFS# I STAT#  DIMSK8# I08UF ) 

IF  (.NOT.  ISTAT)  GO  TO  1950 

SET  UP  FOR  LPA11  SUBSYSTEM  NUMBER 

SPECIFY  START  WORD  CHANNEL  OF  CHANNEL  ZERO  (I/O  GUIDE  PAGE  5-22) 

IDSC  =  0 

SPECIFY  EVENT  MARK  WORD  CHANNEL  OF  CHANNEL  0 
IEMC  =  0 

SPECIFY  DIGITAL  START  WORD  MASK  OF  ALL  BITS 
ID  SW  ■  -1 

SPCEIFY  EVENT  MARK  WORD  MASK  Of  ALL  BITS 
I E  MW  =  -1 
ICALL  =  703 

CALL  LPASLAMSKS  (DIMSK8#IUNIT##IDSC#IEMC#IDSW#IEMW#) 

RELEASE  THE  BUFFER  (BUFFER  NUMBERS  ARE  USED  RATHER  THAN  NAMES) 

ICALL  *  704 

CALL  LPASRLSBUF  (DIBUF9#ISTAT#0) 

IF  (.NOT.  ISTAT)  GO  TO  1950 

START  DIGITAL  INPUT  SWEEP  BY  SPECIFYING  ONLY  ONE  BUFFER 

FOR  THIS  MODE#  THE  NUMBER  OF  POINTS  MUST  EQUAL  NUMBER  OF  FRAMES 
NPOINT  =  NFRAME 

SPECIFY  ONLY  ONE  BUFFER  TO  BE  FILLED 
NBUF  =  1 

IN  REV  C  OF  THIS  ROUTINE#  ISMODE  IS  SPECIFIED  IN  THE  CALLING  PARAMETERS 
PROCEED  WITH  SWEEP  START  CALL 

SWEEP  CALL  SPECIFIES  FLAG  BE  SET  AT  COMPLETION 
ICALL  *  705 

CALL  LPASDISWP  < D I BUFB# NPOINT#NBUF # I SMOD E# # XV AL ( I FL AG ) ## 

1  ICH AN# NCHAN# ISTAT) 

IF  (.NOT.  ISTAT)  GO  TO  1950 


RETURN  TO  CALLING  PROGRAM  ...  ISTAT  IS  STATUS  OF  DIGITAL  INPUT  SWEEP  CALL 
GO  TO  1950 


u  u  u  u  u  u  u  u  u  u  u  u  u 
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c  *****  MODE  =  8  ***** 

C  START  DIGITAL  OUTPUT  SWEEP  FOR  "CHANNEL  8"  /<>'.• 

C 

800  CONTINUE 
C 

C  CLEAR  DIGITAL  OUTPUT  EVENT  FLAG 
ICALL  =  800 

ISTAT  =  SYSSCLREF  (XV AL ( I  FLAG) ) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  CHECK  THAT  NCHAN  IS  EQUAL  TO  ONE 
ISTAT  =  0 
ICALL  =  801 

IF  (NCHAN. NE.1)  GO  TO  1950 
ISTAT  =  1 

INITIALIZE  D08UFB  ARRAY  FOR  SWEEP 
ICALL  =  802 

CALL  LPAJSETIBF  (DOBUFB, ISTAT, D0MSK8,I0BUF) 

IF  (.NOT.  ISTAT)  GO  TO  1950 

SET  UP  FOR  LPA11  SUBSYSTEM  NUMBER 

SPECIFY  START  WORD  CHANNEL  OF  CHANNEL  ZERO  (I/O  GUIDE  PAGE  5“22) 

IDSC  =  0 

SPECIFY  EVENT  MARK  WORD  CHANNEL  OF  CHANNEL  C 

I  EMC  =  0  . 

SPECIFY  DIGITAL  START  WORD  MASK  OF  ALL  BITS  Wf 

IDSW  =  -1 

SPCEIFY  EVENT  MARK  WORD  MASK  OF  ALL  BITS 
I E  MW  =  -1 
ICALL  =  803 

CALL  LPASLAMSKS  (D0MSK9,IUNIT,,IDSC,I£MC,IDSW,IEMW,) 

RELEASE  THE  BUFFER  (BUFFER  NUMBERS  ARE  USED  RATHER  THAN  NAMES) 

ICALL  =  804 

CALL  LPASRLSBUF  (DOBUFB, ISTAT, 0) 

IF  (.NOT.  ISTAT)  GO  TO  1950 
C 

C  FOR  THIS  MODE,  THE  NUMBER  OF  POINTS  MUST  EQUAL  NUMBER  OF  FRAMES 
NPOINT  =  NFRAME 

C  SPECIFY  ONLY  ONE  BUFFER  TO  BE  FILLED 
NBUF  =  1 

C  IN  REV  C  OF  THIS  ROUTINE,  ISMODE  IS  SPECIFIED  IN  THE  CALLING  PARAMETERS 
C 

C  IN  DO  MODE,  A  DELAY  OF  A  LEAST  150  MICROSECONDS  MUST  BE  SPECIFIED  BEFORE 
C  THE  FIRST  CONVERSION  TAKES  PLACE.  SINCE  THE  LPASXRATE  CALL  RETURNS  THE  V 
C  OF  IRATE  (SPECIFYING  A  CLOCK  RATE),  LDELAY  (THE  DELAY  IN  IRATE 
C  UNITS  8EF0RE  FIRST  SAMPLE)  IS  SET.  (PARA  2.4.1  OF  LPA11  USER'S  GUIDE) 

C  IRATE  =  1  FOR  1  MHZF  IRATE  =  2  FOR  100  KHZ,’  IRATE  =  3  FOR  1CKHZ,*  ETC. 
LDELAY  =  1 

IF  (IRATE. EQ.1)  LDELAY  =  150 

IF  (  IRATE .  EQ.  2)  LDELAY  =  15  V-V 

IF  (IRATE. EQ. 3)  LDELAY  =  2 
C  SPECIFY  SAMPLE  ON  EVERY  CLOCK  OVERFLOW 
IDWELL  =  1 


•  V  W  >  *-*’•«’* 


v  » -  r.  ^  ■■  ■»v  r  ^  -  v  y  «- ^  --  v  ^v,w  *%TT  VT%n  ’V.n.'^T* 
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C  PROCEED  WITH  SWEEP  START  CALL 

C  SWEEP  CALL  SPECIFIES  FLAG  BE  SET  AT  COMPLETION 
ICALL  *  805 

CALL  LPASDOSWP  (DOBUFBsNPOINTsNBUFsISNODEsIDWELLsXVALdFLAG)# 

1  LDELAY/-ICHAN,NCHAN*ISTAT> 

IF  (.NOT.  ISTAT)  GO  TO  1950 

C  C^4  4 

C  RETURN  TO  CALLING  PROGRAM  ...  ISTAT  IS  STATUS  OF  DIGITAL  OUTPUT  SWEEP  CAL 
GO  TO  1950 


c  *****  MODE  *  13  ***** 

C  GET  STATUS  OF  A/D  SWEEP 
C 

1300  CONTINUE 
C 

ICALL  =  1301 

ISTAT  =  LPASIWTBUF(ADBUF) 

LSTAT  =  IAND(ADI0SB(3)»*FF00,X)/256 
GO  TO  1950 
C 
C 

C  *****  MODE  =  14  ***** 

C  GET  STATUS  OF  D/A  SWEEP 
C 

1400  CONTINUE 
C 

ICALL  =  1401 

ISTAT  =  LPASIWTBUF(DABUF) 

LSTAT  *  IAND(DAI0S8(3)*,FF0Q*X)/256 
GO  TO  1950 
C 
C 

c  *****  MODE  *  15  ***** 

C  GET  STATUS  OF  DIGITAL  INPUT  SWEEP  FOR  "CHANNEL  A" 
C 

1500  CONTINUE 
C 

ICALL  *  1501 

ISTAT  =  LPASIWTBUF(DIBUFA) 

LSTAT  =  IAND(DII0SA(3)r*FF00'X)/256 
GO  TO  1950 
C 

c 

c  *****  mode  =  16  ***** 

C  GET  STATUS  OF  DIGITAL  OUTPUT  SWEEP  FOR  "CHANNEL  A 
C 

1600  CONTINUE 
C 

ICALL  =  1601 

ISTAT  =  LPASIWTBUF(DOBUFA) 

LSTAT  =  IANO(DOIOSA<3)**FFOO*X)/256 
GO  TO  1950 
C 
C 

C  *****  MODE  =  17  ***** 

C  GET  STATUS  OF  DIGITAL  INPUT  SWEEP  FOR  "CHANNEL  B” 
C 

1700  CONTINUE 
C 

ICALL  =  1701 

ISTAT  =  LPASIWTBUF(DIBUFB) 

LSTAT  =  IAND(DIIOSB(3)**FFOO*X>/256 
GO  TO  1950 
C 
C 

c  *****  MODE  =  18  ***** 

C  GET  STATUS  OF  DIGITAL  OUTPUT  SWEEP  FOR  "CHANNEL  B 
C 

1800  CONTINUE 


nnnon 


ICALL  *  1301 

ISTAT  =  LPASIWTBUF (DOBUFB) 

LS  TAT  =  IANOfDOIOSBOJ/^FOO'XJ/ZSd 
SO  TO  1950 


*****  ERROR  SERVICE  ROUTINE  ***** 

1950  CONTINUE 

C  TRANSFER  STATUS  INFORMATION  ON  CALLING  PARAMETER 
C 


RETURN 


THE  FOLLOWING  ERROR  HANDLER  DEMONSTRATES  THE  GENERAL 
OVERALL  RECOMMENDED  FORM  THAT  THE  USER'S  OWN  ERROR 
HANDLER  SHOULD  FOLLOW. 

THIS  ERROR  HANDLER  UPON  BEING  INVOKED  WRITES  ALL 
MESSAGES  TO  THE  DATA  FILE:  *  PROERROR. L06* .  ERROR 
AND  WARNING  EXPLANATION  MESSA6ES  ARE  ARE  WRITTEN  TO 
A  DATA  FILE  FOR  2  REASONS: 


1.  THE  ERROR  HANDLER  SHOULD  NOT  IMMEDIATELY 
WRITE  INFORMATION  OUT  ON  THE  PS  300  SCREEN 
SINCE  THE  EXPLANATORY  TEXT  DEFINING  THE  ERROR 
OR  WARNING  CONDITION  MAY  BE  TAKEN  AS  DATA  BY 
THE  PS  300  AND  THEREFORE  WIND  UP  NOT  BEING 
DISPLAYED  ON  THE  PS  300  SCREEN  (AS  IN  THE 
CASE  OF  A  CATASTROPHIC  DATA  TRANSMISSION 
ERROR). 

2.  THE  LOGGING  OF  ERRORS  AND  WARNIN6S  TO  A 
LOGFILE  ALLOWS  ANY  ERRORS  AND/OR  WARNINGS 
TO  BE  REVIEWED  AT  A  LATER  TIME. 


SUBROUTINE  ERR  <  ERRCOD  ) 


PROCEDURAL  INTERFACE  ERROR  HANDLER: 


INCLUDE 

INTEGER** 

INTEGER** 

LOGICAL 

DATA 

EXTERNAL 


•PROCONST. FOR/NOLI  ST* 
ERRCOD 
PSVMSERR 
FILOPN 

FILOPN  /.FALSE./ 
PSVMSERR*  DETERH*  PIDCOD 


IF  (FILOPN)  GOTO  1 


OPEN  ERROR  FILE  FOR  LOGGING  OF  ERRORS: 

OPEN  (UNIT=1 0*  FILE=*PROERROR.LOG**  STATUS* *  NEW* * 

8  D ISP*  *  KEEP*  *  ORGANIZATION='SEOUENTIAL'* 

8  ACC£$S**SE8UENTIAL**  C ARRIAGECONTROL=*LIST* ) 

FILOPN  *  .TRUE. 

END  IF 

1  CALL  PIDCOD  (ERRCOD) 

IF  (ERRCOD  .LT.  512)  GOTO  3 

WRITE  (10*  *)  'PS-I-ATOCOMLNK:  ATTEMPTING  TO  * 

8  //  ’DETACH  PS  300/H0ST  COMMUNICATIONS  * 

&  //  ’LINK.' 


WHEN  WE  ATTEMPT  TO  PERFORM  THE  DETACH*  USE  A 
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DIFFERENT  ERROR  HANDLER  SO  AS  NOT  TO  SET  CAUGHT 
IN  A  RECURSIVE  LOOP  IF  WE  CONSISTENTLY  GET  AN 
ERROR  WHEN  ATTEMPTING  TO  DETACH. 

CALL  PDTACH  (DETERH) 

CLOSE  <UNIT=1Q) 

IF  ( ( ERRCOD  .LT.  PSFPAF)  .OR. 

8  (ERRCOD  .GT.  PSFPPF))  60T0  2 

IDENTIFY  VMS  ERROR  IF  THERE  WAS  ONE 

CALL  LIBSSTOP  (XVAL  (PSVMSERR  (>>> 

GOTO  3 
ELSE 

2  STOP 
END  IF 

END  IF 

3  RETURN 
END 


SUBROUTINE  DETERH  (ERRCOD) 


MAIN  ERROR  HANDLER  DETACH  ERROR  HANDLER; 


INTEGER**  ERRCOD 
EXTERNAL  PIDCOD 

WRITE  (10*  *)  'PS-I-ERRVARDET:  ERROR/WARNING  * 

8  //  *  TRYING  TO  DETACH  • 

8  //  'THE  COMMUNICATIONS' 

WRITE  (10*  *)  'LINK  BETWEEN  THE  PS  300  AND  THE  HOST.' 
CALL  PIDCOD  (ERRCOD) 

RETURN 

END 


SUBROUTINE  PIDCOD  (ERRCOD) 


PIDCOO:  IDENTIFY  PROCEDURAL  INTERFACE  COMPLETION 
CODE. 


INCLUDE  'PROCONST. FOR/NOLIST' 

INTEGER**  ERRCOD 
CHARACTER  VM$DEF*133*  PIDEF*133 
INTEGER**  PSVMSERR 
CHARACTER  MSSG1*55*  MSSG2*67 

PARAMETER  (MSSGl  =  'PS-W-UNRCOMCOD:  PROCEDURAL  ' 
8  //  'INTERFACE  ' 

8  //  ' (GSR )  COMPLETION  ') 

EXTERNAL  PSVMSERR 

WRITE  <10*  *)  'PS-I-PROERRWAR:  PROCEDURAL  * 

8  //  'INTERFACE  WARNING/' 


\  ",  \  *  *,  *. 


•* N  A  A  •-  * 


8  //  *  ERROR  COMPLETION  CODE  WAS  • 

WAITE  (10,  *>  'RECEIVED.* 

IF  (ERRCOD  .NE.  PSW3NC )  GOTO  1 

WRITE  <10,  *)  'PS-W-BADNAMCHR:  BAD  CHARACTER 
S  //  'IN  NAME  WAS  ' 

5  //  'TRANSLATED  TO: 

GOTO  1000 

ELSE 

1  IF  (ERRCOD  .NE.  PSWNTL)  GOTO  2 

WRITE  (10,  O  'PS-W-NAMTOOLON:  NAME  TOO  ' 

6  //  'LONG.  NAME  WAS  ' 

&  //  'TRUNCATED  TO  ' 

WRITE  <10,  *)  '256  CHARACTERS.* 

GOTO  1000 
ELSE 

2  IF  (ERRCOD  .NE.  PSWSTL)  GOTO  7 

WRITE  (10,  *)  'PS-W-STRTOOLON:  STRING  TOO  * 

&  //  'LONG.  STRING  ' 

8  //  'WAS  TRUNCATED  • 

WRITE  (10,  *>  'TO  240  CHARACTERS.' 

GOTO  1000 
ELSE 

7  IF  (ERRCOD  .NE.  PSWAAD)  GOTO  8 

WRITE  <10,  *>  'PS-W-ATTALRDON:  ATTACH  * 

8  //  'ALREADY  DONE.  • 

8  //  'MULTIPLE  CALL  TO  PATTCH  WITHOUT 

WRITE  <10,  *)  'INTERVENING  PDTACH  CALL  IGNORED 
GOTO  1000 
ELSE 

8  IF  (ERRCOD  .NE.  PSWAKS)  GOTO  9 

WRITE  (10,  *)  'PS-W-ATNKEYSEE:  ATTENTION  KEY 

8  //  'SEEN  (DEPRESSED). ' 

CALL  PIBMSP 
GOTO  1000 
ELSE 

9  IF  (ERRCOD  .NE.  PSWBGC)  GOTO  10 

WRITE  <10,  *>  'PS-W-BADGENCHR:  BAD  GENERIC  ' 

8  //  'CHANNEL  CHARACTER.  BAD  • 

WRITE  (10,  *)  'CHARACTER  IN  STRING  SENT  VIA: 

8  //  ' PPUTG X  WAS  TRANSLATED  TO  ' 

WRITE  <10,  *)  'A  BLANK.' 

CALL  PIBMSP 
GOTO  1000 
ELSE 

10  IF  (ERRCOD  .NE.  PSW3SC )  GOTO  11 

WRITE  <10,  *>  'PS-W-BADSTRCHR:  BAD  • 

8  //  'CHARACTER  IN  STRING  WAS  ' 

8  //  'TRANSLATED  TO  A  BLANK.' 

CALL  PIBMSP 
GOTO  1000 
ELSE 

11  IF  (ERRCOD  .NE.  PSWBPC)  GOTO  12 

WRITE  (10,  *)  'PS-W-BADPARCHR:  BAD  PARSER  * 

8  //  'CHANNEL  CHARACTER.  BAD  • 

8  //  'CHARACTER  IN  STRING  SENT  TO' 

WRITE  (10,  *)  »ps  300  PARSER  VIA:  PPUTP  • 

8  //  'WAS  TRANSLATED  TO  A  BLANK.' 

CALL  PIBMSP 
GOTO  1000 
ELSE 
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12  IF  (EftftCOD  .NE.  PSEIMC)  GOTO  13 

WRITE  <10/  *>  'PS-E-INVNUXCMA:  INVALID  ' 
&  //  'MULTIPLEXING  CHANNEL  ' 

&  //  'SPECIFIED  IN  CALL  TO:' 

WRITE  <10/  *>  ' PMUXC Is  PMUXPs  OR  PHUXG.' 


GOTO  1000 

C 

ELSE 

13  IF  <  ERRCOD  . 

NE. 

PSEIVC)  GOTO  14 

WRITE  <10/ 

*> 

'PS-E-INVVECCLA: 

INVALID  1 

ft 

// 

'VECTOR  LIST  CLASS 

« 

ft 

tt 

'SPECIFIED* 

WRITE  <10/ 

*) 

•IN  CALL  TO:  PVC6EG. * 

GOTO  1000 

c 

ELSE 

14  IF  <  ERRCOD  . 

NE. 

PSEIVD)  GOTO  15 

WRITE  <10/ 

*> 

'PS-E-INVVECDIH: 

INVALID  * 

ft 

// 

'VECTOR  LIST  DIMENSION  ' 

s 

// 

'SPECIFIED  IN  CALL 

TO' 

WRITE  <10/ 

*) 

'PVCBEG. ' 

GOTO  1000 

C 

ELSE 

15  IF  <  ERRCOD  . 

NE. 

PSEPOE)  GOTO  16 

WRITE  <10/ 

*> 

'PS-E-PREOPEEXP: 

PREFIX  ' 

ft 

// 

'OPERATOR  CALL  WAS 

t 

ft 

// 

'EXPECTED.' 

GOTO  1000 

c 

ELSE 

16  IF  < ERRCOD  . 

NE. 

PSEFOE)  GOTO  17 

WRITE  <10/ 

*) 

•PS-E-FOLOPEEXP: 

FOLLOW  ' 

ft 

// 

•OPERATOR  CALL  WAS 

• 

ft 

it 

'EXPECTED.' 

GOTO  1000 

c 

ELSE 

17  IF  < ERRCOD  . 

NE. 

PSELBE)  GOTO  18 

WRITE  <10/ 

*) 

•PS-E-LA8BLKEXP: 

CALL  TO  ' 

ft 

it 

'PLAADD  OR  PLAEND 

WAS  ' 

ft 

// 

'EXPECTED.' 

GOTO  1000 

c 

ELSE 

18  IF  < ERRCOD  . 

NE. 

PSEVLE )  GOTO  19 

WRITE  <10/ 

O 

'PS-E-VECLISE XP: 

CALL  TO  ' 

ft 

// 

'PVCLIS  OR  PVC END 

t 

ft 

// 

'WAS  EXPECTED.' 

GOTO  1000 

c 

ELSE 

19  IF  <  ERRCOD  . 

NE. 

PSEAMV)  GOTO  20 

WRITE  <10/ 

*> 

'PS-E-ATTMULVEC: 

ATTEMPTED 

ft 

// 

'MULTIPLE  CALL  ' 

ft 

// 

'SEQUENCE  TO  PVCLIS  IS  NOT' 

WRITE  <10s  O  'PERMITTED  FOR  BLOCK  ' 

&  //  'NORMALIZED  VECTORS.' 

GOTO  1000 
C  ELSE 

20  IF  ( ERRCOD  .NE.  PSEMLB)  GOTO  21 

WRITE  <10/  *)  'PS-E-MISLABBEG:  MISSING  ' 
ft  //  'LABEL  BLOCK  BEGIN  CALL.  ' 

ft  U  'CALL  TO  PLAADD  OR  PLAEND* 

WRITE  <10/  *>  'WITHOUT  CALL  TO:  PLABEG.' 
GOTO  1000 
C  ELSE 


21  IF  ( ERRCOD  .NE. 
WRITE  <10,  O 
// 
It 

WRITE  <10,  *> 


ft 

ft 


// 


PSEMVB )  GOTO  22 
•PS-E-MISVECBEG:  MISSING 

'VECTOR  LIST  BEGIN  ' 
'CALL.  CALL  TO  PVCLIS* 
•OR  PVC END  WITHOUT  CALL  • 
'TO:  PVCBEG. * 


GOTO  1000 
ELSE 

22  IF  (ERRCOD  .NE. 


PSENUN)  GOTO  23 


WRITE 

<10,  O 

•PS-E-NULNAM:  NULL  NAME  * 

ft 

// 

•PARAMETER  IS  NOT  ALLOWED.* 

GOTO 

1000 

ELSE 

IF  (ERRCOD  .NE. 

PSE9CT)  GOTO  24 

WRITE 

<10,  o 

•PS-E-BADCOMTYP:  BAD  * 

ft 

// 

•COMPARISON  TYPE  OPERATOR  * 

ft 

II 

•SPECIFIED  IN  * 

WRITE 

<10,  *> 

•CALL  TO:  PIFLEV. * 

GOTO 

1000 

ELSE 

IF  (ERRCOD  .NE. 

PSEIFN)  GOTO  25 

WRITE 

<10,  *> 

•PS-E-INVFUNNAM:  INVALID  ' 

ft 

// 

•FUNCTION  NAME.  * 

ft 

// 

•ATTEMPTED  PS  300* 

WRITE 

<10,  *> 

•FUNCTION  INSTANCE  FAILED  * 

ft 

// 

•BECAUSE  THE  NAMED  * 

ft 

// 

•FUNCTION  CANNOT  POSSIBLY' 

WRITE 

<10,  *) 

•EXIST.  THE  FUNCTION  NAME  * 

ft 

II 

•IDENTIFYING  THE  * 

ft 

II 

•FUNCTION  TYPE  TO  INSTANCE* 

WRITE 

<10,  *) 

•WAS  LONGER  THAN  256  CHARACTERS 

GOTO 

1000 

ELSE 

25  IF  (ERRCOD  .NE. 
WRITE  <10,  *> 
II 
II 

WRITE  <10,  *) 


ft 

s 


& 


// 


PSENNR )  GOTO  26 
'PS-E-NULNAHREQ:  NULL  NAME 

'PARAMETER  IS  • 

•REQUIRED  IN  OPERATE  NODE' 
'CALL  FOLLOWING  A  PPREF  OR  ' 
'PFOLL  PROCEDURE  CALL.* 


GOTO  1000 
ELSE 

26  IF  (ERRCOD  .NE. 

WRITE  <10,  *> 
ft  U 

ft  // 

GOTO  1000 
ELSE 

27  IF  (ERRCOD  .NE. 

WRITE  <10,  *> 
II 
II 

WRITE  <10,  *) 


PSETME)  GOTO  27 
•PS-E-TOOMANEND:  TOO  * 

'MANY  END. STRUCTURE  CALLS  * 
' INVOKED.  ' 


ft 

ft 


ft 

ft 


// 

// 


PSENOA)  GOTO  26 
•PS-E-NOTATT:  THE  PS  300 

•COMMUNICATIONS  LINK  * 
•HAS  NOT  ' 

•YET  BEEN  ESTABLISHED.  * 
•PATTCH  HAS  NOT  BEEN  • 
•CALLED  OR  FAILED.' 


GOTO  1000 
ELSE 

28  IF  (ERRCOD  .NE. 
WRITE  <10,  *> 
II 
// 


PSEODR )  GOTO  29 
•PS-E-OVEDURREA:  AN  * 

•OVERRUN  OCCURRED  DURING  * 
•A  READ  OPERATION.* 


ft 

ft 


WRITE 

<10,  o 

•THE 

SPECIFIED  INPUT  BUFFER 

8 

It 

•IN 

CALL  TO:  PGET  ' 

8 

II 

'OR: 

PGETW* 

WRITE 

<10,  *> 

'WAS 

TOO  SMALL  AND  * 

8 

II 

'TRUNCATION  HAS  OCCURRED.' 

GOTO 

1000 

ELSE 

29  IF  < ERRCOD  .NE.  PREICP)  GOTO  38 

38  IF  (ERRCOD  .NE.  PSEPDT)  GOTO  39 

WRITE  <10,  *>  'PS-E-PHYDEVTYP:  MISSING  ' 

&  //  *  OR  INVALID  PHYSICAL  * 

8  //  'DEVICE  TYPE' 

WRITE  <10,  *>  'SPECIFIER  IN  CALL  TO  PATTCH 
CALL  PVAXSP 
GOTO  1000 
ELSE 

39  IF  (ERRCOD  .NE.  PSELDN)  GOTO  40 

•  WRITE  <10,  *)  'PS-E-LOGDEVNAN:  MISSING  • 

8  //  'OR  INVALID  LOGICAL  ' 

&  //  'DEVICE  NAME* 

WRITE  <10,  *>  'SPECIFIER  IN  CALL  TO  PATTCH 
CALL  PVAXSP 
GOTO  1000 
ELSE 

40  IF  (ERRCOD  .NE.  PSEADE)  GOTO  41 

WRITE  <10,  *>  'PS-E-ATTDELEXP:  ATTACH  ' 

8  //  'PARAMETER  STRING  • 

8  //  'DELIMITER' 

WRITE  <10,  *)  "•/"  WAS  EXPECTED.' 

CALL  PVAXSP 
GOTO  1000 
ELSE 


41  IF  (ERRCOD  .NE.  PSFPAF)  GOTO  42 


WRITE  <10, 

*) 

'PS-F-PHYATTFAI: 

• 

8 

// 

'PHYSICAL  ATTACH 

OPERATION  • 

8 

GOTO  1000 
ELSE 

II 

'FAILED.' 

IF  (ERRCOD  . 

NE. 

PSFPDF)  GOTO  43 

WRITE  <10, 

*) 

'PS-F-PHYDETFAI: 

PHYSICAL  f 

8 

It 

•DETACH  OPERATION 

« 

8 

GOTO  1000 

n 

'FAILED.' 

ELSE 

43  IF  (ERRCOD  .NE.  PSFPGF)  GOTO  44 

WRITE  <10,  O  'PS-F-PHYGETFAI:  PHYSICAL  * 
8  //  'GET  OPERATION  FAILED.' 

GOTO  1000 
ELSE 

44  IF  (ERRCOD  .NE.  PSFPPF)  GOTO  45 

WRITE  <10,  *>  'PS-F-PHYPUTFAI:  PHYSICAL  ' 
8  //  'PUT  OPERATION  FAILED.' 

GOTO  1000 
ELSE 

45  IF  (ERRCOD  .NE.  PSF8TL)  GOTO  46 

WRITE  <10,  *)  'PS-F-BUFTOOLAR:  BUFFER  * 

8  II  'TOO  LARGE  ERROR  IN  • 

8  //  'CALL  TO:  PSPUT.' 

WRITE  <10,  *>  'THIS  ERROR  SHOULD  NEVER  * 

//  'OCCUR  AND  INDICATES  A  ' 


8 


u  u  u  u 


C-56 


8 


11 

WRITE  <10,  *) 
CALL  PVAXSP 
GOTO  1000 
ELSE 

46  IF  ( ERRCOD  .NE. 


'PROCEDURAL  INTERFACE  (GSR>* 
'INTERNAL  VALIDITY  CHECK.' 


A 


WRITE 

(10,  o 

8 

// 

i 

11 

WRITE 

<10,  o 

i 

11 

8 

11 

WRITE 

<10,  *> 

8 

11 

8 

11 

WRITE 

<10,  o 

CALL 

PVAXSP 

GOTO 

1000 

ELSE 

47 

IF  (ERRCOD  .NE. 

WRITE 

<10,  o 

8 

// 

8 

// 

WRITE 

(10,  *) 

8 

// 

8 

// 

WRITE 

<10,  *) 

CALL 

PVAXSP 

GOTO 

1000 

PSFWNA)  GOTO  47 
PS-F-WRONUMARG:  WRONG  ' 

NUMBER  OF  ARGUMENTS  ' 

IN  CALL  TO  PROCEDURAL' 
INTERFACE  (GSR)  LOW-LEVEL  * 
I/O  PROCEDURE  ' 

(SOURCE  FILE:  PROIOLIB.MAR) , 
THIS  ERROR  SHOULD  NEVER  • 
OCCUR  AND  INDICATES  A  ' 
PROCEDURAL  INTERFACE  (GSR)' 
INTERNAL  VALIDITY  CHECK.' 


PROMPT 


PSFPTL)  GOTO  48 
'PS-F-PROTOOLAR: 

'BUFFER  TOO  LARGE 
'ERROR  IN  CALL  TO:  PSPRCV.' 
•THIS  ERROR  SHOULD  NEVER  ' 
'OCCUR  AND  INDICATES  A  ' 
'PROCEDURAL  INTERFACE  (GSR)' 
•INTERNAL  VALIDITY  CHECK.' 


ELSE 


UNKNOWN  ERROR  MESSAGE  ERROR  MESSAGE. 


48 


49 


50 


51 


IF  (ERRCOD  .GE. 
MSSG2  =  MSSG1 
GOTO  51 
ELSE 

IF  (ERRCOD  .GE. 
MSSG2  s  MSSG1 
GOTO  51 
ELSE 

MSSG2  =  MS  SGI 
END  IF 
END  IF 
WRITE  <10, 

WRITE  (10, 

WRITE  (10, 


512)  GOTO  49 
//  'WARNING* 


1024)  GOTO  50 
//  'ERROR  ' 


//  'FATAL  ERROR 


8 

8 


O 

*) 

*) 

// 

U 


MSSG2 

•CODE  IS  UNRECOGNIZED.' 
•PROBABLE  PROCEDURAL  ' 
•INTERFACE  (GSR)  INTERNAL 
•VALIDITY  CHECK  ERROR.' 


END  IF 


1000 

IF  (CER 

RCOD  .LT. 

PSFPAF)  .OR. 

8 

(  E  R 

RC  00  .GT. 

PSFPPF) )  GOTO  2000 

CALL 

PSFVMSERR 

<  VMSDEF,  PIDEF  ) 

WRITE 

<10,  *) 

•DEC  VAX/VMS  ERROR  ' 

8 

// 

'DEFINITION  IS:' 

WRITE 

<10,  *) 

VMSDEF 

WRITE 

<10,  *) 

'PROCEDURAL  INTERFACE  ' 

8 

// 

' (GSR)  INTERPRETATION  OF  ' 

8 

// 

•DEC  VAX/VMS  COMPLETION  CODE:' 

WRITE 

(10,  *) 

PIDEF 

C-57 


WRITE  (10,  *)  *  DEC  VAX/VMS  ERROR  CODE  • 

&  //  'VALUE  WAS:  ',  PSVHSERR  C) 

C  END  IF 

2000  WRITE  (10,  *) 

RETURN 

END 


SUBROUTINE  PIBMSP 


C 

C  PI8HSP:  WRITE  THE  "IBM  VERSION  SPECIFIC" 

C  MESSAGE  TO  THE  ERROR  HANDLER  FILE. 

C 


WRITE  CIO, 

& 

& 

WRITE  <10, 

RETURN 

END 


•)  'THIS  ERROR/WARNING  IS  ' 

//  'APPLICABLE  ONLY  TO  THE  IBM  ' 
//  'VERSION  OF  THE' 

*>  'PROCEDURAL  INTERFACE  (GSR).' 


SUBROUTINE  PVAXSP 


C 

C 

C 

c 

c 


PVAXSP:  WRITE  THE  "DEC  VAX/VMS  VERSION 

SPECIFIC"  MESSAGE  TO  THE  ERROR 
HANDLER  FILE. 


WRITE  (10,  *) 

«  // 

i  // 

WRITE  (10,  O 
RETURN 
END 


'THIS  ERROR/WARNING  IS  ' 
•APPLICABLE  ONLY  TO  THE  DEC  ' 
'VAX/VMS  VERSION  OF' 

'THE  PROCEDURAL  INTERFACE  (GSR) 


